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ABSTRACT 


The  objective  of  this  analytical  study  was  to  develop  an  optimal 
emitter  location  algorithm  using  Kalman  filtering  techniques  to  filter 
emitter  bearing  angles -of-arrival  information  in  an  airborne,  multi¬ 
emitter  environment.  Since  emitter  and  aircraft  navigation  data  were 
sampled  at  discrete  time  intervals,  discrete  sequential  estimation 
techniques  were  utilized  within  a  software  computer  program  which 
initially  sorted  data,  filtered  emitter  bearing  angles -of-arrival  to 
obtain  optimal  estimates,  and  computed  emitter  positions  in  latitude/ 
longitude  coordinates  using  various  emitter  location  algorithms.  An 
error  analysis  was  performed  on  the  emitter  location  algorithms  to 
determine  relative  accuracy  of  the  different  techniques.  Extended 
Kalman  filtering  was  also  considered  as  an  alternate  approach  to  the 
emitter  location  algorithm. 
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I.  INTRODUCTION 

One  goal  of  a  it  borne  direction-finding  (DF)  is  to  obtain  the 
location  of  an  electromagnetic  radiation  source  in  latitude /longitude 
coordinates  on  the  earth’s  surface.  Over  the  years  many  emitter 
location  techniques  have  been  devised,  and  much  research  has  been 
devo«ed  to  optimizing  bearing  angle  measurements  in  angle-only 
dir ecM on-finding  and  navigation  systems.  Much  of  the  effort  has  been 
directed  toward  physical  components  such  as  the  directional  receiving 
antenna  and  the  improvement  of  its  characteristics,  hi  airborne  DF 
systems  current  typical  bearing  angle -of -arrival  (AOA)  accuracy  is 
found  to  be  about  +  2°  at  microwave  frequencies.  Despite  such 
accuracy  a  multiple  bearing  fix  will  yield  considerable  emitter  position 
ambiguity  at  any  significant  range  between  the  emitter  and  the  airborne 
DF  system. 

To  improve  this  situation  a  statistical  optimal  estimate  of  each 
received  emitter  bearing  angle  was  computed  using  sequential  estima¬ 
tion  techniques,  commonly  called  Kalman  filtering.  Additionally,  an 
adaptive  gating  technique  was  utilized  which  selectively  filtered  out 
bearing  lines  which  did  not  closely  associate  with  other  bearing  lines 
already  filtered  and  correlated  to  a  distinct  emitter  location.  Smooth¬ 
ing  techniques  were  utilized  to  improve  ttie  unfiltered  initial  bearing 
angle,  and  a  smoothed  initial  bearing  angle  and  filtered  final  bearing 
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angle  were  used  in  a  spherical  earth  triangulation  solution,  to  estimate 
the  emitter  position.  The  entire  sorting,  filtering,  smoothing,  gating, 
and  triangulation  procedure  was  organized  within  a  software  computer 
program  capable  of  automatically  estimating  multiple  emitter  locations 
given  noisy  emitter  bearing  angle  data  and  aircraft  navigation  data. 


II.  ANALYSIS  OF  THE  PROBLEM 


A.  APPLICATION 

The  objective  of  this  analytical  study  was  to  develop  an  optimal 
emitter  location  algorithm  which  would  have  application  to  military 
aircraft  flights  in  an  operational  environment.  The  computer  program 
developed  could  be  utilized  in  an  airborne  digital  computer  system  to 
give  real-time  analysis  of  emitter  parameters  in  a  multiple  emitter 
environment,  or  it  could  be  used  in  a  ground-based  computer  system 
to  give  post-flight  analysis  of  large  quantities  of  compiled  data.. 

Since  all  data  sampling  and  processing  was  done  at  discrete  time 
intervals,  discrete  sequential  estimation  techniques  were  utilized. 

The  real  facility  in  using  sequential  estimation  techniques  is  that  each 
subsequent  computation  is  based  only  on  the  new  observation  and  the 
last  previously  calculated  estimate,  and  these  recursive  equation  com¬ 
putations  require  a  minimum  of  computer  storage  to  filter  a  large 
quantity  of  data.  This  makes  such  an  emitter  location  algorithm  ideal 
for  airborne  computer  application  [lj. 

To  allow  generality  of  application,  the  software  system  was 
developed  to  process  multiple  emitter  locations,  to  sort  and  filter 
large  quantities  of  emitter  data,  to  filter  data  at  non-uniform  sampling 
intervals,  and  to  estimate  emitter  locations  on  any  region  of  the  earth's 
surface.  It  was  initially  assumed  that  no  errors  existed  in  the  aircraft 
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navigation  data;  hence  these  position  data  together  with  two  or  more 
filtered  emitter  bearing  angles  could  be  used  to  compute  the  emitter 
location  (see  Figure  1).  If  a  deterministic  aircraft  navigation  error 
was  known  to  exist,  it  could  be  compensated  for  in  the  emitter  location 
algorithm.  If  a  random  error  existed  in  the  aircraft  navigation  data, 
it  could  be  minimized  by  using  a  non- zero  §  matrix  to  account  for 
random  excitation  noise  (see  Section  III,  Part  B,  page  17)  or  by  Kal¬ 
man  filtering  the  aircraft  navigation  data  as  well  as  the  emitter  bear¬ 
ing  data.  Kalman  filtering  techniques  have  also  been  developed  to 
optimize  navigation  system  accuracy  [2]. 

Y 
axis 

yt 

Y. 

l 

Yf 

Xj  xf  XT  X  axis 

FIGURE  1 

GEOMETRY  OF  EMITTER  LOCATION 
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B.  KALMAN  FILTER  UTILIZATION 


A  signal  X,  measured  in  the  presence  of  random  white  Gaussian 
noise  V,  is  filtered  in  an  attempt  to  recover  the  original  signal.  The 

A 

filtered  estimate  of  the  state  is  denoted  by  X.  From  Kalman  filter 
theory  [3]  for  discrete  S3' stems  using  first-order  difference  equations, 
the  kth  noisy  observation  ZAk)  of  the  state  is  given  by 

Z(k)  =JH(k)X(k)  +  V<k)  k  «  1,  2,  3,  «  •  .  (1) 

where  H(k)  is  the  observation  matrLx  and  V(k)  is  the  measurement 
noise.  Since  a  discrete  or  sampled  system  is  being  considered,,  k 
denotes  the  kth  time  sample. 

The  state  of  a  general,  discrete  system  with  no  deterministic 
forcing  function  is  given  by 

X(k+1)  =  j£(k+l, k)X(k)  +  rw(k)  k  *•  1*  2r  .  ..  (2) 

where  $(k  ■  1,  k)  is  the  state  transition  matrix,  V  is  a  distribution 
matrix  related  to  the  random  forcing  function,  ar.d  W(k)  is  a  random 
forcing  function  to  account  for  random  excitation  noise.  It  was 
assumed  that  the  noise  sequences  have  zero  mean  and  second-order 
statistics  described  by 


Ery<k)V(j)TJ 

=  _R(k)8<kj) 

% 

(3) 

J?E[w<k)W(j)T]  _rT  =  Q(k)8(kj) 

(4) 

E[v(k)W(j)T 

|  =  0  for  all  k,  j 

(5) 
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is  the  Kronecker  delta. 


where 


8<kj) 


0  k*j 
1  k=j 


The  Kalman  filter  recursion  equations  [1]  are  summarized 
below  where  X(k/j)  denotes  the  estimate  of  the  state  X(k)  based  upon  j 
measurement  observations  Z(l),  Z(2),  .  .  .  .  »  Z(j). 

G(k)  =  P(k/k-l)H(k)T^H(k)P(k/k-l)H(k)T  +R(k)J"1  (6) 

P(k/k)  =  P(k/k-l)  -  G(k)H(k)P(k/k-l)  (7) 

P(k+l/k)  =  ^(k-rl,k)P(k/k)^(k+l,k)T  +Q(k)  (8) 

X(k/k)  =  X(k/k-l)  +  G(k)£z(k)  -  H(k)X(k/k-l)J  (9) 

X(k/k-l)  =  j$(k,k-l)$(k-l/k-l)  (10) 


The  Kalman  filter  gains  are  represented  by  the  matrix  G(k),  and 
P(k/j)  represents  the  error  covariance  matrix  of  the  various  estimates. 

For  the  problem  being  considered  the  states  are  bearing  angle- 
of-arrival  and  bearing  rate,  and  it  is  desired  to  filter  the  noisy 
observed  bearing  angles  to  obtain  optimal  estimates  of  these  states. 

The  system  dynamics  were  approximated  by  a  1/s^  plant  which  results 
in  a  state  transition  matrix  given  by 


$Mk+l,k) 


1  T(k+1) 


1 


Since  only  the  bearing  angle  of  the  state  was  observed,  R(k)  and  W(k) 
become  scalar  variance  terms  and  the  bracketed  terms  in  equations 
(6)  and  (9)  become  scalars  as  well.  This  considerably  simplified 
reducing  these  matrix  equations  to  scalar  form  (see  Appendix  A); 
however,  allowing  a  non-uniform  sampling  interval  required  that  the 
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term  T(k+1)  remain  a  variable  in  each  of  the  applicable  recursion  equa¬ 
tions.  This  required  that  error  covariance  terms  and  Kalman  filter 
gains  be  computed  on  line  since  they  were  a  function  of  the  sampling 
interval;  therefore,  these  terms  could  not  be  precomputed  and  stored. 

Several  assumptions  are  implicit  here.  Modeling  the  system 
dynamics  with  a  l/s^  transfer  function  gives  a  linear  approximation 
that  may  not  adequately  represent  the  actual  system  equations,  which 
are  non-linear  [4].  It  may  then  become  necessary  to  augment  the 
dynamic  model  with  an  additional  difference  equation  which  includes 
the  second  derivative  of  the  measured  bearing  angle,  or  extended 
Kalman  filtering  techniques  may  be  employed  to  more  accurately 
approach  the  non-linearity  of  the  dynamic  system.  Extended  Kalman 
filtering  techniques  are  discussed  in  Section  III,  Part  F,  of  this  paper. 

The  statistical  nature  of  Kalman  filtering  techniques  requires 
that  the  statistics  of  the  measurement  noise  V(k)  and  the  excitation 
noise  W(k)  be  completely  specified,  or  if  unknown  they  must  be 
assumed.  If  no  deterministic  errors  are  known  to  be  coloring  these 
noise  sources,  the  assumption  of  white  noise  may  be  a  good  one  al¬ 
though  it  may  not  exactly  model  the  actual  noise  bearing  error.  Kal¬ 
man  filtering  assumes  that  the  noise  is  independent  from  one  sampling 
interval  to  the  next  {5].  This  may  not  be  an  accurate  assumption  since 
successive  bearing  angle  observations  from  a  single  emitter  might 
have  similar  error  statistics.  Any  deterministic  bias  in  aircraft 
antenna  bearing  angle-of-arrival  measurement  would  further  negate 
this  assumption.  This  difficulty  was  reported  by  Reeves  [6],  who  recom 
mended  that  emitter  bearing  .angle-of-arrival  measurement  noise  be  . 
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considered  to  have  both  random  and  correlated  components.  This 
would  require  augmenting  the  state  vector  equation  with  an  additional 
variable  and  further  complicate  the  Kalman  filtering  process. 

C.  SMOOTHING  TECHNIQUES 

Since  Kalman  filtering  techniques  sequentially  filter  the  second 
and  subsequent  bearing  angle  observations  associated  with  a  single 
emitter,  the  first  bearing  angle  associated  with  a  particular  emitter 
remains  unfiltered  and  no  optimal  estimate  exists.  Thus  a  technique 
of  filtering  backward  in  time  or  smoothing  was  used  to  improve  the 
estimate  of  the  initial  bearing  angle.  The  smoothing  equations  are 
similar  to  Kalman  filter  equations  in  that  they  are  recursive  and 
functions  of  similar  statistical  parameters,  but  they  update  or  smooth 
previous  data  based  on  more  recent  data  that  has  been  optimally 
estimated. 

A  general  technique  proposed  by  Rauch  (7]  gives  the  smoothed 
estimate  of  the  initial  observation  after  k  time  intervals  as 

X(l/k)  =_X(l/k-l)  +  D(l/k)G'k)£z(k)  -  H(k)X(k/k-l)]  (11) 

where  D(l/k)  =  D(l/k-l)P(k-l/k-l)$(k, k-l^Pfk/k-Dr1  (12) 

For  a  non-uniform  sampling  interval  D(l/k)  becomes  a  function  of 
T(k)  and  must  be  solved  sequentially  before  the  smoothed  initial 
estimate  X(l/k)  can  be  computed.  For  an  analysis  of  these  equations 
reduced  to  scalar  form,  see  Appendix  B.  These  scalar  smoothing 
equations  were  included  in  the  software  computer  program  and  yielded 

a  smoothed  estimate  of  the  initial  bearing  angle  and  bearing  rate. 
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in.  COMPUTATIONAL  PROCEDURE 


A.  INITIAL  DATA  SORT 

The  problem  was  posed  to  accommodate  a  realistic  airborne 
environment  with  multiple  emitters  at  various  RF  frequencies,  emitter 
bearing  angle-of-arrival  errors,  and  a  constant  velocity  moving  air¬ 
craft.  Aircraft  navigation  and  emitter  target  data  was  sampled  and 
recorded  at  discrete  but  time- varying  intervals.  Since  the  number  of 
emitters  was  unknown  and  large  quantitites  of  signal  data  were  recorded 
at  various  frequencies,  pulse  repetition  frequencies  (PRF),  and  pulse 
widths  (PVV),  it  was  necessary  that  the  data  be  initially  sorted  by  fre¬ 
quency  and  PRF  to  initially  estimate  the  number  of  distinct  emitter 
targets.  This  was  accomplished  with  sufficiently  small  frequency  and 
PRF  gates  to  separate  and  associate  emitter  parameters  with  a  distinct 
emitter  target.  Additionally,  it  was  found  that  multiples  of  PRF  may 
exist  which  associate  with  a  single  emitter,  so  a  check  for  PRF  multi¬ 
ples  had  to  be  included  within  the  PRF  sorting  subroutine.  One  set  of 
data  processed  by  this  program  included  PRF  multiples  given  on  page  59. 

Multiple  emitters  of  the  same  frequency  and  PRF  could  still 
result  in  an  ambiguous  solution;  therefore,  each  bearing  angle  initially 
associated  with  a  distinct  emitter  by  the  initial  data  sort  wras  sequen¬ 
tially  filtered  and  gated  to  determine  if  it  correlated  with  this  emitter. 
Due  to  the  large  quantity  of  data  to  be  processed,  any  bearing  angle  not 
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correlated  to  a  distinct  emitter  after  being  filtered  and  gated  was  dis¬ 
carded  from  the  data  bank.  Further  investigation  and  greater  computer 
storage  capability  could  allow  such  discarded  bearing  angles  to  be  re¬ 
associated  with  a  different  emitter;  however,  this  process  was  not 
developed  within  this  analysis. 

B.  KALMAN  FILTER  INITIALIZATION 

Initialization  of  the  Kalman  filter  equations  requires  a  knowledge 
of  the  system  dynamics,  the  statistical  properties  of  the  Kalman  filter 
parameters,  and  some  information  about  the  initial  state  of  the  system. 
Since  it  was  necessary  to  associate  each  sorted  data  sample  (emitter 
bearing  angle  and  associated  emitter  data)  with  a  particular  emitter, 
the  notation  JSET  (I,  J)  was  devised,  where  I  is  the  emitter  target 
number  with  which  the  data  sample  is  associated  and  J  is  the  jth  sample 
of  sequential  data  associated  with  that  emitter.  JSET(I,  J)  gives  the 
sequential  sample  number  for  this  data  sample  when  listed  together 
with  all  other  data.  See  page  63  for  a  listing  of  initial  JSET  data.  To 
initialize  the  Kalman  filter  equations,  KI  was  used  as  the  initial  JSET 
value;  i.  e.,  JSET(1, 1)  =  KI  for  the  ith  emitter  target. 

To  filter  emitter  bearing  angles-of-arrival,  the  noisy  observation 


of  the  state  from  equation  (1)  is  given  by 
0(k)  =  H(k)  0(k)  +  V(k) 


(13) 


[0<k)] 

where  0  (k)  =  I  .  I  =  vector  of  noisy  measured  observations, 

““  [0(k)J 

re<k>l 

©(k)  =  .  =  state  vector  of  exact  emitter  bearing  angle 

[e(k)J 

and  bearing  rate,  and  H(k)  =  [l  0}  is  the  observation  matrix  for 

measurement  of  only  noisy  bearing  angle  0  .  Since  the  bearing  rate 

• 

0  (k)  was  not  measured,  it  must  be  estimated  to  initialize  the  sequen¬ 
tial  estimation  process.  This  bearing  rate  depends  on  the  speed  and 
heading  of  the  aircraft  with  respect  to  the  emitter,  the  relative  bearing 
angle  -of- arrival ,  and  the  range  r  to  the  emitter.  Since  the  range  to  an 
unknown  emitter  is  unknown,  it  must  be  estimated.  For  this  program 
r  =  150  nautical  miles  was  assumed  and 

0(KI)  =  ^sin(BRNG)  x  degrees /second  (14) 

r  3600 

where  BRNG  =  relative  bearing  angle-of-arrival 
PIRAD  =  57.29578  degrees /radian 
v  =  aircraft  velocity  in  knots. 

If  an  estimated  value  of  range  to  the  emitter  is  known  and  different 
from  150  nautical  miles,  then  this  new  value  should  be  used  in 
equation  (14)  and  substituted  into  the  computer  program. 

Since  an  initial  optimal  estimate  was  not  available  to  the  filtering 
process  described  by  equations  (9)  and  (10),  the  first  bearing  angle 
optimal  estimate  THTD(KI)  was  assumed  equal  to  the  noisy  measured 
bearing  angle  THETAD(KI),  and  the  first  bearing  rate  estimate  TDTD(KI) 
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was  assumed  equivalent  to  0(KI).  The  smoothing  process  was  simi¬ 
larly  initialized. 

The  initial  uncertainty  of  emitter  bearing  angle  and  angle  rate  on 
filter  initialization  was  accounted  for  in  the  initial  values  of  the  error 
covariance  matrix  P(l/0).  Since  stationary  emitter  locations  were 
considered,  the  random  forcing  function  W(k)  of  the  dynamic  state 
equation  (2)  could  be  set  to  zero  if  exact  knowledge  of  the  observer’s 
aircraft  position  were  known.  However,  since  the  aircraft  position 
may  have  both  random  and  deterministic  errors  associated  with  its 
position  measurement  and  because  of  the  simplified  matrix,  a  non¬ 
zero  matrix  was  utilized.  For  W(k)  having  a  zero  mean  and 
Efw(k)2]  -  1.0  degrees2  from  equation  (4) 


‘T2(k)‘ 

rr4(k)  T3(k)-i 

Q(k)  = 

2 

T(k)  _ 

[1,0][T2(k)  T(k)]  = 

4  2 

T3(k)  T2(k) 

Ct  " 

The  value  of  R(k),  the  scalar  variance  of  the  measurement  noise, 
was  assumed  to  be  constant  and  estimated  according  to  the  angle  meas¬ 
urement  accuracy  of  the  DF  system  being  considered.  The  initial  D 
matrix  for  the  sequential  smoothing  process  was  initialized  as  the 
identity  matrix  (see  Appendix  B). 

When  utilizing  this  program  for  emitter  location  with  different 


known  measurement  and  covariance  statistics,  these  initialization 
parameters  must  be  changed  in  the  computer  program  to  ensure  optimal 
solution  locations.  The  only  other  term  which  must  be  modified  by  the 


program  user  is  the  value  of  NUM,  which  is  the  total  number  of  data 
samples  to  be  sorted  and  filtered  by  this  program.  Since  the  data  for 
each  emitter  must  be  filtered  separately,  the  filter  process  occurs 
once  for  each  distinct  emitter  target  as  determined  by  the  initial  data 
sort.  Once  an  optimal  estimate  of  emitter  bearing  angle  and  bearing 
rate  have  been  initialized,  the  filter  process  is  ready  to  commence. 

C.  KALMAN  FILTER  PROCESS 

The  Kalman  filter  equations  utilized  to  filter  the  states,  emitter 
bearing  angle  8  and  bearing  rate  0  ,  are  those  noted  on  page  11  shown  as 

A  A 

equations  (6)  through  (10)  with  X  replaced  by  j0_.  Since  these  are  vector 
equations  and  tedious  to  handle  within  a  computer  program,  their 
scalar  counterparts  were  derived  (see  Appendix  A)  and  utilized  within 
the  program.  The  optimal  estimation  equation  is  similar  to  equations 
(9)  and  (10)  and  is  given  by 

^(k/k)1  |"l  T(k)l  rfck-l/k-lf  I" Gl(k) 

0(k/k)J  [O  1  J  0(k-l/k-l)  G2(k) 

where  E(k)  =  0(k)  -  ^(k-l/k-l)  -  T(k)&k-l/k-l)  (17) 

results  in  a  scalar  term  since  only  one  of  the  state  variables  was 
measured. 

Due  to  the  non-uniform  sampling  interval,  the  Kalman  filter  gains 
Gl(k)  and  G2(k)  may  vary  and  not  approach  a  steady  state  value  at  a 
uniform  rate  as  they  would  with  a  constant  sampling  interval.  This  is 
shown  graphically  in  Figure  2,  which  depicts  the  transient  Kalman 


E(k)  (16) 
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FIGURE  2 


KALMAN  FILTER  GAIN  SCHEDULE 
FOR  A  NON-UNIFORM  SAMPLING  INTERVAL 
KALMAN  FILTER  PROCESS 


ELAPSED  TIME  t(k)  IN  SECONDS 

NOTES: 

1.  Points  plotted  above  represent 'discrete  values  of  Kalman  filter  gain 
G1(K)  associated  with  filtering  the  bearing  angle  of  the  state  vector. 

2.  Since  the  prediction  covariance  matrix  (P(k+l/k)  given  by  equation  (8) 
is  a  function  of  jt(k+l,k),  which  contains  the  sampling  interval  T(k+1), 

it  can  be  seen  that  the  Kalman  filter  gain  G(10  will  also  vary  with  T(k+1) 
as  in  equation  (6).  As  *be  sampling  interval  increases,  the  gain  will  also 
increase. 
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FIGURE  3 

KALMAN  FILTER  GAIN  SCHEDULE 
FOR  A  UNIFORM  SAMPLING  INTERVAL 
KALMAN  FILTER  PROCESS 


KAIMAN  FILTER  GAIN 

+  +  +•  +  +  +  +  +  +  +  + 
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NOTES: 

1.  Points  plotted  above  represent  discrete  values  of  Kalman  filter  gain  G1(K) 
associated  with  filtering  the  bearing  angle  of  the  state  vector. 

2.  After  ten  sampling  intervals  the  gain  has  nearly  reached  a  steady  state 
value  of  0,417.  This  asymptote  is  determined  by  the  non-zero  value  of  the 
Q  matrix. 

3.  If  system  random  excitation  noise  (i.e.i  the  Q  matrix)  were  assumed 
to  be  zero,  then  the  Kalman  filter  gain  would  approach  zero  upon  reaching 
steady  state. 
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filter  gain  schedule  of  a  non-uniform  sampling  interval.  Figure  3 
shows  the  Kalman  filter  gain  schedule  of  a  uniform,  twelve-second 
sampling  interval  computer  simulation,  which  was  developed  to  allow 
an  error  analysis  to  be  made  on  the  Kalman  filter  program. 

The  adaptive  gate  was  chosen  to  be  a  function  of  the  prediction 
variance  term  Pll(k/k-l),  which  is  a  variable  function,  and  the 
measurement  noise  variance  R(k),  which  is  constant.  The  adaptive 
gate  was  set  to  selectively  compare  the  filtered  bearing  angle  with 
previously  correlated  bearing  angles.  If  a  filtered  bearing  does  not 
fall  within  the  adaptive  gate,  it  is  discarded  and  the  sampling  interval 
increases  to  the  last  previous  correlated  bearing.  This  increases  the 
Kalman  filter  gain  and  opens  the  adaptive  gate  to  a  wider  allowable 
value  until  a  subsequent  bearing  angle  is  found  which  correlates  to  this 
emitter,  then  causing  the  adaptive  gate  to  reduce  in  size.  The  adaptive 
gate  was  chosen  to  be 

GATE(K)  =  C  •  ^  Pll(k) +R(K)  (18) 

where  C  is  a  constant  scale  factor.  Since  the  prediction  covariance 
P(k/k-l)  may  be  defined  as 

P(k/k-l)  =  E  |[©Jk)  -jSWk-1)]  [®00  "  jjjk/k-l)]T},  (19) 

which  is  a  function  of  the  mean  square  error  between  the  true  value  of 
the  bearing  angle  and  its  optimal  estimate,  it  can  be  seen  that  as  the 
estimate  error  increases  the  adaptive  gate  will  increase  and  as  the 
optimal  estimate  approaches  the  true  value  the  gate  size  will  decrease 
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as  is  desired.  The  constant  term  R  (k)  prevents  the  gate  from  getting 
so  narrow  that  no  emitter  bearing  angles  could  correlate  to  a  distinct 
emitter,  and  the  variable  term  Pll(k)  allows  the  gate  size  to  "adapt" 
to  the  transient  filter  errors  as  was  noted  above. 

D.  INITIAL  BEARING  ANGLE  SMOOTHING  PROCESS 

In  order  to  obtain  a  smoothed  estimate  of  the  first  bearing  angle 
associated  with  eacn  emitter  target,  it  was  necessary  to  solve  equation 
(11)  sequentially  within  the  Kalman  filter  process  since  the  gain  term 
was  recomputed  after  each  sampling  interval.  The  smoothed  initial 
bearing  angle  estimation  equation  used  in  the  software  program  is 
similar  to  equation  (11)  and  is  given  by 

£(l/k-l)l  fbll(l/k)  D12(l/k)]fGl(kf 

^  +  E(k),  (20) 

0(l/k-l)  D21(l/k)  D22(l/k)  G2(k) 

-  L.  v.  J 

where  E(k)  is  defined  by  equation  (17)  and  the  scalar  terms  in  the  D 

matrix  are  as  derived  in  Appendix  B.  To  compute  these  terms,  both 

<I>(k, k-1)"*  and  P(k/k-l)”*  had  to  be  determined.  The  inverse  of  the 

state  transition  matrix  is  obviously  given  by 

fl  -T(k) 

^(k.k-ir1  =  .  (21) 

0  1 

Should  the  error  covariance  matrix  become  singular  because  of  numer¬ 
ical  inaccuracy  in  computation,  no  inverse  will  exist.  In  this  case 
corrective  action  must  be  taken  before  attempting  to  compute  the 
inverse.  Several  references  have  discussed  this  problem,  suggested 


a  ■ 
0(l/k) 

0(1 Ik) 


solutions,  and  Schmidt  [8]  gives  a  survey  of  current  techniques  in  this 
area.  For  this  program,  the  IBM  360  subroutine  MINV  was  utilized  to 
compute  the  error  covariance  matrix  inverse  with  good  numerical 
accuracy. 


E.  EMITTER  LOCATION  ALGORITHMS 

Several  techniques  were  investigated  to  obtain  a  computationally 
simple  yet  accurate  algorithm  to  calculate  the  emitter  locations.  Since 
more  than  two  bearing  lines  may  result  in  an  ambiguous  emitter  loca¬ 
tion,  it  was  most  logical  to  use  only  the  smoothed  initial  bearing  angle 

/\  /s 

and  the  filtered  final  bearing  angle  0^  to  compute  the  location*  Any 

such  location  procedure  would  give  most  accurate  results  if  the  two 
bearings  intersected  at  right  angles;  however,  infrequent  data  collec¬ 
tion,  short-leg  flight  tracks,  or  long-range  distances  from  the  emitter 
generally  prevent  such  choice  of  initial  and  final  bearing  angles, 

1.  Plane  Triangulation  Solution 

The  basic  "flat  earth"  triangulation  solution  was  presented 
by  Kayton  and  Fried  [9]  and  discussed  in  some  detail  in  Refs.  6  and  10. 
Figure  1  depicts  the  geometry  of  the  triangulation  method  of  emitter 
location  solution,  and  the  solution  equations  are  given  by 


and 


^  xT  _  xA 


Yt  -  Y. 

_  Xf 


tan  Q.  = 

£ 

tan  0  f 


YT-  Yf 


(22) 


(23) 


where  the  emitter  location  coordinates  (X-p,  Y-p)  are  unknown  and  must 
be  determined. 
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If  latitude  (L)/ longitude  (X)  coordinates  are  substituted,  for. 
the  X/Y  axes  in  the  flat  earth  model,  the  following  equations  result: 


tan  0. 


tan8f 


(X>p  "Xj)^osL/p 


(XT  -Xf)cosLT 


(24) 


(25) 


These  equations  gave  a  more  accurate  solution  but  were  more  complex 
to  program  since  one  of  the  unknowns  (Lp)  occurs  both  as  an  explicit 
function  and  as  a  cosine  function.  This  difficulty  was  resolved  by 
solving  for  an  intermediate  value  of  emitter  latitude  (TILA)  based  on  an 
aircraft  midlatitude  cosine  function  (WAV)  which  was  known  and  then  by 
recomputing  emitter  latitude  (TLA)  based  on  the  cosine  function  of  the 
intermediate  emitter  latitude.  The  resulting  equations  are  given  by 


Li  +  Lf 


WAV  = 


(26) 


(X-  -  Xi)cos(WAV)  +  L.tanQ.  -  Lftan& 

TILA  =  -£ - i - s - - L_J_  (27) 

tan0j  -  tan0f 


(Xf  -Xi)cos(TILA)  +  L.tan0.  -  L,tan0. 

TLA  =  — - - - ^ - £ - £  (28) 

tan0j  -  tan0f 

TLO  =  Xf  -  (Lt  -  Lf)tan$f/ cos  (TILA)  (29) 

where  TLA  =  emitter  target  latitude  Lp 


TLO  =  emitter  target  longitude  XT 


Lj  =  initial  aircraft  position  latitude 
Xj  =  initial  aircraft  position  longitude 
Lf  =  final  aircraft  position  latitude 
Xf  =  final  aircraft  position  longitude. 

These  equations  are  derived  in  Appendix  C  and  are  equivalent  to  the 
"round  world"  model  developed  on  pages  41-43  of  Ref.  6. 

2.  Spherical  Triangulation  Solution 

Two  approaches  to  a  spherical  earth  solution  were  taken. 

The  first  involved  the  derivation  of  a  spherical  triangulation  solution 
with  two  equations  resulting  from  two  spherical  triangles  as  shown  in 
Fig.  4.  These  equations  are  derived  in  Appendix  D  and  are  given  by 
/v  tan^X™  -  X.)cos  Lt| 

tan  0ji  =  - LJE - i - IJ  {30) 

sin(LT  -  L-) 

/\  tan  |(XT  -  XJcosL  1 

tan0f  =  - - - -  .  (31) 

sin(LT  -  Lf) 

These  equations  represent  exact  solutions  for  emitter  loca¬ 
tion  on  a  spherical  earth  of  constant  radius.  It  is  known  that  the  earth 
is  an  oblate  spheroid  so  small  errors  may  be  introduced  at  large  dis¬ 
tances  from  the  emitter  with  such  a  spherical  earth  solution.  However, 
according  to  Kayton  and  Fried  [9],  a  constant  radius  of  curvature  can  be 
used  everywhere  on  the  earth  with  an  error  of  less  than  0.2  percent  of 
distance. 

If  the  emitter  location  problem  is  concerned  only  with  micro- 
wave  frequency  emitters,  then  relatively  short  distances  from  the 
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FIGURE  4 


SPHERICAL  EARTH  TRIANGULATION  SOLUTION 
FOR  EMITTER  LOCATION 


FIGURE  4a 


B 

u„ 


TRIANGLE 


FIGURE  4c 
FINAL  SPIJER ICAL 
TRIANGLE 


aircraft  to  the  emitter  will  exist  since  microwave  electromagnetic 
(EM)  energy  propagation  approximates  a  straight  line  path  (line-of- 
sight)  on  the  earth's  surface.  Reintjes  and  Coate  [11]  show  that  the 
maximum  distance  for  direct  EM  wave  propagation  to  a  radar  horizon 
is  given  by 

d  =  ^2h£  +  ^2 iT  ,  (32) 

where  d  =  radar  horizon  in  statute  miles 
ha  =  aircraft  altitude  in  feet 
hfi  =  emitter  altitude  in  feet 

assuming  a  4/3  effective  radius  of  the  earth  for  standard  EM  energy 
refraction  characteristics.  If  he  is  unknown  or  assumed  to  be  zero, 
then  aircraft  altitudes  (ha)  up  to  80, 000  feet  should  not  yield  radar 
horizons  greater  than  400  statute  miles  (350  nautical  miles).  At  this 
distance  latitude /longitude  differences  between  the  aircraft  and  emitter 
are  small  (less  than  6° ),  and  it  can  be  seen  that  the  emitter  location 
algorithm  developed  from  equations  (24)  and  (25)  is  nearly  equivalent 
to  the  exact  spherical  solution  from  equations  (30)  and  (31)  since  the 
tangent  and  sine  functions  of  small  angles  are  approximately  equal  to 
the  radian  measure  of  the  angles  themselves.  Thus  for  ranges  up  to 
360  nautical  miles  from  the  emitter,  the  planar  solution  will  be  less 
than  0. 5  percent  in  error  from  the  spherical  solution.  For  ranges  of 
less  than  150  nautical  miles  the  error  may  be  neglected  and  the  plane 
triangulation  solution  may  be  considered  sufficiently  accurate  for 
emitter  location  estimation. 
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If  greater  accuracy  is  desired,  the  spherical  triangulation 
equations  (30)  and  (31)  may  be  solved  by  an  iterative  procedure  as 
suggested  in  Appendix  E.  It  was  found  to  be  tedious  to  attempt  a 
closed-form  solution. 

3.  Earth-Centered  Coordinate  System  Solution 

Another  approach  to  the  spherical  earth  solution  was  con¬ 
sidered  using  tangent  plane  projections  and  an  earth-centered  coordi¬ 
nate  system  (xj,  x^.x^),  where  the  x^  axis  is  the  polar  axis  and  the  Xj, 
X-2  plane  is  the  equatorial  plane  of  the  earth.  An  observation  plane  was 
defined  for  each  emitter-bearing  line,  which  passed  through  the  center 
of  the  earth  and  inscribed  a  great  circle  arc  on  the  earth's  surface 
between  the  aircraft  and  emitter  positions.  The  procedure  for  obtain¬ 
ing  the  emitter  location  required  solving  the  equations  of  the  observa¬ 
tion  planes,  two  at  a  time,  with  a  constraint  equation  that  the  emitter 
be  located  on  the  earth's  surface.  Assuming  a  constant  earth  radius 
and  letting  Xg  equal  a  constant,  the  emitter  position  may  be  computed 
from  the  equations  of  the  plane  (xj,  c)  where  Xg  =  constant  as  shown 
below. 

allx/  +  a12x2  =  "a13c  *33^ 

a21x^  +  a22xjf  =  "a23c  (34) 

These  equations  were  then  transformed  back  to  the  original 
coordinate  set  (xj.Xg.x^)  by  the  equation 

x.  =  Ax'  i  =  1,  2,  3.  (35) 
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(36) 


where  A  =  Re/(x^  + 
and  Re  =  average  radius  of  the  earth. 

With  proper  coordinate  rotation,  it  is  possible  to  have  the  projection 
plane  (xg  =  c)  tangent  to  the  earth's  surface  and  centered  at  the  aircraft 
observation  position. 

F.  EXTENDED  KALMAN  FILTERING 

It  may  be  desirable  to  directly  filter  and  update  the  estimates  of 
emitter  position  (L^,,X^t)  as  described  by  Reeves  [6],  If  only  bearing 
angle -of- arrival  information  is  available  as  observable  data,  however, 
a  non-linear  transformation  must  be  utilized  to  transform  observable 
bearing  angles  into  filtered  position  estimates. 

This  was  accomplished  by  extended  Kalman  filtering  techniques 
utilizing  the  concepts  of  small  perturbation  theory  and  a  Taylor  series 
expansion  about  an  initial  point.  Equation  (1)  then  becomes 

Z(k)  =  N^X(k)J  +V(k)  (37) 

where  Z(k)  represents  the  observable  bearing  angles,  X(k)  is  the 
emitter  position  vector,  and  N  represents  the  non-linear  transforma¬ 
tion  given  by 

(38) 

If  the  position  error  of  the  state  vector  X(k)  is  given  by 

X(k)  =  X(k)  -  X(k)  ,  (39) 

then  the  true  position  X(k)  may  be  expanded  about  the  most  recent 
/\ 

optimal  estimate  X(k)  in  a  Taylor  series  expansion  with  higher  order . 
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terms  neglected  as  shown  below: 


where 


(40) 

(41) 


for  the  emitter  location  algorithm  given  by  equations  (24)  and  (25). 

The  Kalman  filter  recursion  equations  (6)  through  (8)  may  then  be 
rewritten  to  account  for  this  non-linear  observation  matrix  and  are 
given  by 

G(k)  =  P(k/k-l)M(k)T  [^M(k)P(k/k-l)M(k)T  +  R(k)J_1  (42) 

F(k/k)  =  P(k/k-l)  -  G(k)M(k}P(k/k-l)  (43) 

P(k+l/k)  =  ^(k+l,k)P(k/k)4>(k+l,k)T  +  Q(k)  .  (44) 

Since  the  non-linear  filter  is  processing  estimates  of  a  stationary 
emitter  position,  the  matrix  becomes  the  identity  matrix  and  the 
equations  are  considerably  simplified  and  reduced  to  scalar  form 
(see  Appendix  F). 

The  greatest  difficulty  in  this  approach  was  found  in  initialization 
of  the  extended  Kalman  filter  process.  Errors  or  inaccuracies  in 
initialization  may  cause  the  recursive  computations  to  diverge,  and  it 
was  therefore  decided  to  commence  extended  Kalman  filter  processing 
only  after  linear  filtering  and  smoothing  of  the  bearing  angle  observa¬ 
tions  had  been  completed  and  an  initial  optimal  estimate  of  emitter 
position  obtained.  This  would  allow  the  extended  Kalman  filter  process 
to  be  used  as  a  final  correction  procedure  to  further  improve  the  final 
optimal  estimates  of  emitter  position. 
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IV.  PR  ESENTATION  OF  R  ESULTS 


A.  MONTE  CARLO  SIMULATION  ANALYSIS 

Since  this  Kalman  filter  program  was  developed  to  process  actual 
aircraft  flight  data,  a  Monte  Carlo  simulation  was  utilized  to  accom¬ 
plish  program  validity  checks  and  error  analysis  studies.  Figure  5 
depicts  the  geometry  of  the  simulation  with  an  aircraft  flying  due  south 
at  600  knots  off  the  coast  of  southern  California.  Two  VORTAC  stations 
were  chosen  as  emitters  with  accurately  known  positions  given  as 


EMITTER  #1 

Oceanside  VORTAC 

33. 24055*  N 

Channel  100 
Frequency  1197  mHz 

-117. 41694°W 

EMITTER  #2 

San  Diego  VORTAC 

32.  78222°N 

Channel  125 

-117. 22444*  W. 

Frequency  1212  mHz 

. 

Bearing  angle -of- arrival  information  was  assumed  to  arrive  every  six 
seconds  alternately  from  each  target  giving  a  twelve-second  uniform 
sampling  interval  for  simplicity.  Known  true  bearing  angles  were 
computed  numerically  in  the  absence  of  measurement  noise  and  allowed 
position  location  within  twenty  feet  of  the  known  locations  given  above. 

In  the  presence  of  computer-generated  random  measurement 
noise  of  one  degree  variance,  a  large  number  of  simulation  runs  were 
executed  to  obtain  a  statistically  valid  error  analysis.  The  results  of 
this  analysis  are  given  in  Appendix  G  and  summarized  below  for  the 
two  simulation  emitters.  A  range  error  was  computed  from  each 


PLOT  OF  MONTE  CARLO  SIMULATION  AIRCRAFT  TRACK 
AND  EMITTER  BEARING  ANGLES-OF- ARRIVAL 


position  estimation  latitude  and  longitude  error,  and  all  errors  were 
statistically  averaged  for  the  total  number  of  runs. 

MONTE  CARLO  SIMULATION  ERROR  ANALYSIS 
average  error  in  nautical  miles 

normalized 

average  average  average  closest  estimated 

latitude  longitude  range  point  of  position 

emitter  error  error  error  approach  range  error 

1  0.44852  0.23376  0.53692  54.5  0.985% 

2  0.39961  0.23108  0.50758  64.7  0.785% 

These  results  show  that  the  basic  plane  triangulation  solution  emitter 
location  algorithm  is  capable  of  estimating  position  within  one  percent 
of  range  at  emitter  distances  of  less  than  100  nautical  miles. 

B.  AIRCRAFT  FLIGHT  DATA  ANALYSIS 

The  Kalman  filter  program  was  also  utilized  to  process  and  filter 
aircraft  flight  data  of  the  form  discussed  in  Section  III,  Part  A,  of  this 
paper.  This  data  processing  tested  maximum  utility  of  the  computer 
program  since  certain  data  samples  would  not  correlate  with  predicted 
emitter  locations  and  had  to  be  selectively  gated  out.  Figures  6  through 
10  show  graphs  of  noisy  unfiltered  bearing  angle -of -arrival  information 
initially  associated  with  a  distinct  emitter  target.  The  dotted  lines  show 
unfiltered  bearing  angles  and  the  solid  lines  show  the  smoothed  initial 
and  filtered  final  bearing  angle.  It  can  be  seen  that  Figures  7,  9,  and 
10  have  erroneous  bearing  angles  which  must  be  excluded  from  the 
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Kalman  filtering  process  by  the  adaptive  gating  technique.  This  is 
shown  to  occur  in  the  results  of  the  computer  output  on  page  64.  Also 
comparing  the  final  JSET  data  (page  65)  with  the  initial  JSET  data 
(page  63 )  shows  which  data  samples  were  not  correlated  to  a  distinct 
emitter  target  and  were  discarded. 

The  emitter  location  estimation  accuracy  obtained  from  the 
results  of  processing  and  filtering  flight  data  was  not  as  good  as  that 
obtained  from  the  Monte  Carlo  simulation;  however,  it  was  estimated 
that  the  standard  deviation  of  bearing  angle  measurement  noise  was 
approximately  12°  and  that  some  aircraft  navigation  error  may  have 
existed  as  well.  Therefore,  typical  emitter  location  estimation  within 
3  percent  on  an  average  range  from  aircraft  to  emitter  target  of  100 
nautical  miles  was  considered  reasonable. 


34 


FIGURE  7 


PLOT  OF  NOISY  MEASURED  BEARING  ANGLES 
ASSOCIATED  WITH  EMITTER  TARGET 


3R 


FIGURE  8 


PLOT  OF  NOISY  MEASURED  BEARING  ANGLES  . 
ASSOCIATED  WITH  EMITTER  TARGET 
NTAR  =  3 
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FIGURE  9 


PLOT  OF  NOISY  MEASURED  BEARING  ANGLES 
ASSOCIATED  WITH  EMITTER-  TARGET 
NTAR  =  4 


WEST  LONGITUDE  IN  DEGREES 


figure  10 


PL0!ooF  N0ISY  MEASURED  BEARING  ANGLES 
ASSOCIATED  with  EMITTER  TARGET 
NT  AR  =  5 
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V.  CONCLUSIONS 


It  was  found  that  Kalman  filtering  techniques  have  useful  applica¬ 
tion  iu  the  field  of  airborne  direction-finding  and  emitter  location  pro¬ 
cedures.  Many  airborne  directional  antenna  receiving  systems  have 
+10°  typical  bearing  accuracies  which  yield  poor  results  in  conven¬ 
tional  plotting  and  triangulation  procedures  for  emitter  position  fixing. 
The  Kalman  filtering  process,  in  effect,  statistically  filters  out  random 
signal  error  or  measurement  noise,  resulting  in  an  optimal  estimate  of 
the  true  signal. 

B|y  computer  processing  techniques  these  emitter  data  may  be 
sorted  and  sequentially  filtered  to  yield  optimal  estimates  of  bearing 
angle -of -arrival  information.  Computerized  solutions,,  as  suggested 
within  this  paper,  may  then  be  utilized  to  compute  numerical  emitter 
locations  in  latitude /longitude  coordinates  to  a  high  degree  of  accuracy. 
For  limited -storage  airborne  computer  applications  the  Kalman  filter¬ 
ing  process  and  plane  triangulation  solution  should  be  readily  adaptable 
to  airborne  implementation  to  yield  real-time  cockpit  display  outputs 
•with  typical  estimated  emitter  position  error  within  three  percent  of 
the  exact  value. 

For  more  precise  resolution  of  emitter  location,  the  spherical 
earth  triangulation  solution  may  be  considered;  or  alternately,  the 
extended  Kalman  filtering  techniques  may  be  utilized  to  improve  or 
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update  plane  triangulation  solution  initial  estimates  of  emitter  location. 
These  procedures  are  somewhat  more  involved,  however,,  and  would 
require  greater  computer  memory  and  processing  time- 
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APPENDIX  A 


DERIVATION  OF  SCALAR  KALMAN  FILTER 
RECURSION  EQUATIONS 


The  Kalman  filter  recursion  equations  from  page  HI,,  equations 
(6),  (7),  and  (8),  are  listed  below: 

G(k)  =  P(k/k-l)H(k)T  [H(k)P(k/k-l)H(k)T  +  R(k)J“r  (1^ 

P(k/k)  =  JP{k/k-l)  -  G(k)H(k)P(k/k-l)  (2^ 

P(k+l/k)  =  ^(k+l,k)P(k/k)^(k+l»k)T  +  Q(k)  (3^ 

where  in  this  application  <t>  (k+l,k)  =  T(k+l)"j^ 

H(k)  =  [l  o]  , 

the  P  and  ^5  matrices  may  be  considered  to  have  scalar  components 


given  by 


Pll  P12 


P21  P22 


Qll  Q12 
Q21  Q22 


respectively. 


and  the  G  matrix  is  a  2x1  matrix  of  the  form 


Writing  equation  (1A)  in  matrix  notation  yields 


‘Gil  fPll  PI  2*1  fll  r  Pll  P12  l]  -1 

=.  10  +  R  •  (4A) 

G2  P21  P22  0  J  P21  P22  0 

y  W  v  V,  J  L  J 

and  for  the  observation  matrix  H(k)  =  £l  oj,  the  inverse  term  becomes 
a  scalar  allowing  the  gain  terms  to  be  computed  directly,  as  is  shown 


below: 
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<5A) 


which  results  in  the  scalar  gain  equations 


Gl(k) 


Pll(k/k-l) 
Pll(k/k-l)  +R(k) 


G2(k) 


P21(k/k-l) 
Pll(k/k-l)  +R(k) 


(6A) 


(7A) 


From  equation  (19)  which  defines  the  P  matrix,  it  can  be  seen  that  since 
0  and  0  are  statistically  independent,  where 

~  .  A 

0=0-0  . 


then  P12  =  P21,  and  the  P  matrix  is  symmetric.  From  equation  (15)  it 
can  be  seen  that  the  Q  matrix  is  also  symmetric.  Equation  (7A)  then 
becomes 


G2(k)  = 


P12(k/k-l) 
Pll(k/k-l)  +  R(k) 


(8A) 


To  solve  for  the  prediction  covariance  scalar  terms,  equation 
(2A)  was  substituted  into  (3A)  giving 
Pll 
P12 

which  upon  simplifying  and  writing  in  scalar  form  yields  equations  as 
noted  on  page  84  of  the  Kaln-  \n  filter  program. 


Pll  P12 


P12  P22 


21  Mr  if' 

-  [10] 

!J  G2J  L  J  I 


Pll  P12 


PI 2  P22 


k/k-1 


1  0 


T  1 


Qll  Q12 
Q12  Q22 


k/k-1 
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APPENDIX  B 


DERIVATION  OF  SCALAR  SMOOTHING  EQUATIONS 


The  general  smoothing  equations  (11)  and  (12)  are  given  on  page 
13  and  are  repeated  below: 

X(l/k)  =  X(l/k-l)  +  D(l/k)C  (k)E(k)  (IB) 

where  D(l/k)  =  D(l/k-l)P(k-l/k-l)^(k, k-DTHk/k-l)"1  (2B) 

and  E(k)  =  Z(k)  -  H(k)X(k/k-l)  .  (3B) 

a  , 

In  order  to  solve  for  a  smoothed  value  of  the  state  X(l/k),  it  is  first 
necessary  to  solve  equation  (2B)  sequentially  since  the  state  transition 
matrix  4>  is  a  function  of  the  variable  sampling  interval  as  given  by 


$(k,k-l)T  = 


* 

1 

T(k) 

m 


(4B) 


It  is  also  necessary  to  obtain  the  inverse  of  the  error  covariance  matrix 
P  in  order  to  solve  equation  (2B).  On  the  IBM  360,  the  matrix  inverse 
routine  MINV  was  used  with  good  numerical  accuracy,  and  the  results 
were  programmed  as  follows: 


P-1: 

and  letting 
P  = 


Pll 

P12  " 

-i 

fpiNll  PIN12' 

= 

• 

9 

( 

P21 

P22 

PIN21  PIN22 

to 

mJ 

«•  •. 

Pll 

P12 

Dll  D12 

Qll  Q12 

,  D  = 

,  and  Q  = 

P21 

m 

P22 

y 

D21  D22 

■■  y 

Q21  Q22^ 

(5B) 
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as  before.  Since  the  P  matrix  is  symmetric  (as  shown  in  Appendix  A),. 
P“*  is  also  symmetric. 

To  solve  for  the  scalar  smoothing  equations,  equatiorc..(8)  on.  page 
11  was  solved  for  P(k-l/k-l)  giving 

P(k-l/k-l)  =  $(k,k-l)_1  [P(k/k-l)  -  Q(k)J  (k,k-ir!  ,  (6B) 

This  equation  was  then  substituted  into  equation  (2B)  giving 

D(l/k)  =  D(l/k-l)j$(k,  k-lf 1  [jP(k/k-D  -  Q(k)J  PCk/k-l)-1  (7.B) 


which  written  in  matrix  form  yields 


where  QP11  =  Qll(PINll)  +  Q12(PIN12) 

QP12  =  Q1KPIN12)  +  Q12(PIN22) 

* 

QP21  =  Q12(PIN11)  +  Q22(PIN12) 

QP22  =  Q12(PIN12)  +  Q22(PIN22) 

and  D(l/0)  was  initialized  as  the  identity  matrix.  These  are  the  terms 
used  in  the  Kalman  filter  program  to  solve  for  sequential  values  of  the 
D  matrix  as  seen  on  page  84. 
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APPENDIX  C 

DERIVATION  OF  PLANE  TRIANGULATION 
SOLUTION 


From  Figure  1  it  can  be  seen  that 


A  XT  -  Xx 
tan0.  = 


XT- Yj 


A  XT-Xf 

and  tan0f  - - 

1  XT  -  Y f 


(■tC) 


(2C) 


Substituting  latitude  (L)/longitude  (A)  coordinates  for  the  X/Y  axes  of 
the  flat  earth  model  results  in  angular  measurement  of  distance  in  the 
plane.  Since  equal  angles  of  latitude  and  longitude  yield  equal  distances 
of  movement  only  at  the  equator,  a  correction  factor  must  be  applied  to 
longitude  angular  measure  as  either  pole  is  approached  from  the  equator. 

At  60°  North  latitude,  for  example,  one  degree  of  movement 
measures  sixty  nautical  miles  while  one  degree  of  movement  in  longi¬ 
tude  only  measures  thirty  nautical  miles.  This  requires  that  the  longi¬ 
tude  angular  measure  be  corrected  by  the  cosine  of  the  local  latitude 
coordinate  so  that  the  tangent  ratio  terms  will  have  units  of  the  same 
dimensional  size.  This  results  in  the  equations  given  below: 

(\T  “  \j)cosL-ji 


ft 

tanBj 


tan0f 


lT  "  L: 


(A  *J»  “  A^J^OSLrp 
Ltp  —  Lf 


(30 


(4C) 
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These  two  equations  could  be  solved  simultaneously  for  the  two  unknowns: 
Lrj.  and  XT,  except  that  the  unknown  Lp  also  appears  as  a  cosine  function.. 
The  method  chosen  to  resolve  this  difficulty  allowed  a  known,  midlatitude 
function 

Li  +  Lf 

WAV  = - - -  (fire) 

to  be  used  in  approximating  an  intermediate  value  of  emitter  target 
latitude  TILA  where 

A  A 

<Xf  -  X-j)cos(WAV)  +  Lftan‘0.  -  L.tanfL 

TILA  =  — i - - - g - 5 - - - 1 - L  (&C) 

tan§j  -  tan§£ 

results  from  substituting  cos(WAV)  for  cosLp  in  a  simultaneous  solution 
of  equations  (3C)  and  (4C)  for  Lp.  It  should  be  noted  that  this  midlati¬ 
tude  approximation  is  only  valid  if  the  aircraft  position  latitude  is  within 
a  few  degrees  of  the  emitter  location  latitude.  This  approximation  would 
not  be  valid  for  HF  sky  wave  radiation  transmitted  from  an  emitter  at 
great  distances  from  the  receiving  aircraft.  For  situations  in  which  the 
approximation  is  valid,  equations  (28)  and  (29)  give  a  corrected  solution 
for  emitter  latitude  and  longitude  based  on  the  intermediate  latitude 


function  TILA. 


APPENDIX  D 


DERIVATION  OF  SPHERICAL  EARTH 
TRIANGULATION  SOLUTION 


Figure  4a  describes  the  geometry  of  the  spherical  triangulation 
solution,  in  which  the  arc  length  sides  of  the  spherical  triangles  must 
be  measured  from  the  angle  subtended  at  the  center  of  the  sphere. 

Since  latitude  (L)  and  longitude  (X)  lines  meet  at  right  angles  and  0- 
and  0f  are  known,  then  two  angles  of  the  spherical  triangles  are  known. 
This  allows  the  side  opposite  and  the  side  adjacent  to  the  emitter  bear¬ 
ing  angle  0  to  be  computed. 

Using  the  Law  of  Sines  and  the  Angle  Law  of  Cosines  for  spherical 
triangles,  the  general  solution  equations  may  be  derived  as  follows  from 
Figures  4b  and  4c: 

sin(A)  sin(B) _ .  ,  A ,  sin(B)sin(a) 

Sine  Law:  ^  or  Sm,A)  <1D> 

Cosine  Law:  cos(A)  =  -cos(B)cos(C)  +  sin(B)sin(C)cos(a).  (2D) 

For  angle  C  =  90°  equation  (2D)  reduces  to 

cos(A)  =  sin(B)cos(a)  .  (3D) 

Dividing  equation  (ID)  by  (3D)  yields 


tan(A)  = 


sin(A) 

cos(A) 


tan(a) 

sin(b) 


(4D) 


where  a  and  b  are  angular  arcs  of  the  spherical  triangles  measured  at 
the  center  of  the  sphere.  From  Figures  4b  and  4c,  b  is  an  arc  of  latitude 
and  a  is  an  arc  of  longitude  which  must  be  corrected  for  the  local  latitude 
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at  which  it  is  measured.  Therefore, 
a  =  (XT  -  X)cosLt 
and  b  =  LT  -  L  . 

Substituting  these  values  of  a  and  b  into  equation  (5D)  results  in 

tan  0j  =  tan  [  |  X T  -  X  •)cosLT ] 
sin<Lrp  *  L-) 


(50) 

(6D) 


(TD) 


and  tan  0f  =  tan  [(  XT  ~  Xf)cosLT]  (8D) 

sin(L,p  -  Lj) 

which  give  the  exact  solution  for  emitter  location  on  a  spherical  earth 
of  constant  radius. 
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APPENDIX  E 

COMPUTER  ITERATION  SOLUTION  TO 
SPHERICAL  TR I  ANGULATION 
EQUATIONS 

No  closed-form  solution  to  the  two  spherical  triangulation 
equations  (30)  and  (31)  could  be  found  since  the  unknowns  (L^,  X^,)  are 
enmeshed  within  multiple  trigonometric  relations.  Instead,  an  itera¬ 
tive  approximation  computer  solution  was  developed  which  allowed 
successive  numerical  updating  of  previously  computed  values.  This 
method  is  only  as  good  as  the  initial  estimate  with  which  it  commences, 
so  it  is  best  described  as  a  spherical  earth  correction  procedure  to  the 
plane  triangulation  solution  for  emitter  location.  The  procedure  is 
concerned  with  updating  values  of  the  following  terms 

DTLAI  =  LT  -  Lj 

DTLAF  =  LT  -  Lf 

DTLOI  =  XT  -  X. 

DTLOF  =  XT  -  Xf 

by  sequentially  recomputing  them  from  rearranged  versions  of  equations 
(30)  and  (31).  The  phocedure  is  repeated  and  successive  terms  are 
compared  until  a  satisfactory  solution  is  reached.  See  the  computer 
subroutine  on  the  following  page  for  a  further  explanation  of  the  iterative 
process. 
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APPENDIX  F 

DERIVATION  OF  EXTENDED  KALMAN  FILTER 
SCALAR  EQUATIONS 

'  The  extended  Kalman  filter  recursion  equations  (42),.  (43  )„  and 
(44)  are  similar  in  form  to  the  basic  Kalman  filter  recursion. equations 
on  page  11,  except  that  the  observation  matrix  is  a  non-linear  transfor 
mation  matrix  M  as  defined  by  equation  (41)  where 


M(k) 


az  |  r  ae  ae 

axh=UxT 


j  =  [dmx  dmyJ  . 


Taking  partial  derivatives  of  equation  (24)  yields 

(L,,,  -  LjcosL™ 


"*T  (hfjy  *  L-)  +  (  X  rp  "  Xi)  COS  Lrj 


These  terms  are  computed  numerically  and  substituted  into  equations 
(42)  and  (43)  which  are  rewritten  in  matrix  form  as 


Pll  P12  DMX 


GY  P21  P22  DMY 


Pll  P12  DMA 

DMX  DMY  1  +  R 

J  P21  P22  DMY 


Pll  P12  1  |1  01  Pll  P12 


P21  P22 1  0  1  |  P21  P22 


H  fpil  PI 2*|  fl  0 
P21  P22  0  1 


Qll  Q12 


QI2  Q22 


c  ♦ 

C  *  SPHERICAL  EARTH  SOLUTION  SUBROUTINE 

C  * 

C 

C  CORRECTIONS  TO  PLANE  TRI ANGULATION  SOLUTION  FOR 
C  A  SPHERICAL  EARTH 
C 

DO  40  I=l» NTAR 
NSTA=NST  C I ) 

KI=J  SETCIyli 
KF=JSET ( I.NSTA) 

DO  42  M=1 t 5 
CTLA=COS(TLA(I ) ) 

DTLA  1= TLA ( I)-SLA(KI) 

DTLAF=TLA( I J-SLA (KF) 

DTLO I=TLO( I)-SLO(KI) 

DTLOF=TLO( I)-SLO(KF) 

DTL0I=ATAN(TAN(THT1(KF}}*S INCDTLAI } J/CTLA 
DTLOF=ATAN( TAN( THT(KF) }*SIN(DTLAF) J/CTLA 
DTLAI=ARSIN( TAN( DTLOI^CTLA) /TAN{ THTl(KF)  ) ) 
DTLAF=ARSI N( TAN{ DTLOF^CTLA )/TAN!THT (KF } ) ) 
TLAI=DTLAI+SLA(KI ) 

TLAF=DTL AF+SL A ( K  F  J 
TLOI=DTLOI+SLO(KI) 

TLOF=DTLOF+SLCJ  ( KF) 

TLADI=TLAI*P IRAD 
TLADF=TLAF*PIRAD 
TLODI=TLO I^P IRAQ 
TLODF=TLOF*PIRAD 

WRITE ( 6»44)TLAD( I) » TLADI tTLADFf TLODt I ) »TLODI»TLODF 
44  FORMAT!  '0*  ,6Fli>.5) 

TLA(I)  =  (TLAH-TLAF)/2.0 
TLO(  I )  =  (  TLC'I+TLOF)  /2  »0 
TLAD( I J=TLA( I )*PIRAD 
TLOD(I )=TLO( I ) *PIRAD 
42  CONTINUE 
40  CONTINUE 


#** 


Equation  (43)  is  then  substituted  into  (5F);  however,  the  fact  that,  the 
4?  matrix  reduces  to  the  identity  matrix  for  the  stationary  filtered 
states  (Lrp,  X^,)  considerably  simplifies  the  recursion  equations  since 
they  are  no  longer  dependent  on  the  sampling  interval  T(k)..  Since  the 
gain  terms  are  computed  as  a  function  of  the  non-linear  terms  DMX 
and  DMY,  it  is  essential  to  have  the  correct  units  on  the  error  term 
E(k).  In  this  case  the  units  of  gain  are  not  dimensionless  but  degrees  per 
radian,  so  the  error  term  must  be  given  in  radians  to  update  position 
estimates  given  in  degrees  of  latitude  and  longitude. 

These  scalar  equations  may  then  be  written  out  and  programmed 
sequentially  as  was  done  in  Appendix  A  for  the  linear  recursion 
equations.  See  page  92  for  a  listing  of  these  equations  within  the  exten¬ 
ded  Kalman  filter  subroutine. 
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MONTE  CARLO  SIMULATION  ERROR  ANALYSIS 
ESTIMATED  EMITTER  POSITION  ERROR  IN  NAUTICAL  MILES 


EMITTER  #  1  EMITTER  #  2 


RUN 

DLAT1 

0L0N1 

DRNG1 

DLAT2 

DL0N2 

DRNG2 

1 

0.73  975 

0.98967 

1.23559 

0.29480 

0.08906 

0.30796 

2 

-0.17944 

-0.15609 

0.23783 

0.34882 

-0.20192 

0.40305 

3 

0.40009 

-0.01287 

0.40029 

-0.28107 

-0.41036 

0.49738 

4 

0.93292 

0.40690 

1. 01780 

-0.87250 

0.28671 

0.91840 

5 

-0.17761 

-0.13885 

0.22545 

-0.29205 

0.22405 

0.36809 

6 

0.33  783 

-0.09862 

0.35193 

-1.02905 

0.14354 

1.03901 

7 

-0.71136 

0.51^03 

0.87765 

-1. 19751 

0.13350 

1.20493 

8 

-0.60425 

-0.53403 

0.80642 

0.35243 

0.27276 

0.44569 

9 

0.07324 

0.03655 

0.08186 

0.063)7 

0.09631 

0.11518 

10 

-1.38245 

0.37886 

1.43342 

1. 10687 

-0.43230 

1.18329 

11 

0.61066 

0.05379 

0.61302 

0 • 307  62 

-0.20006 

0.36695 

12 

-0.47058 

0.07356 

0. 47630 

-0.10986 

-0.01153 

0.11047 

13 

-0.31036 

0.19127 

0.36457 

-0.68390 

-0.07289 

0.68777 

14 

1.21033 

0.20184 

1.22704 

0.23712 

0.14354 

0.27718 

15 

-0.23254 

0.  17724 

0.29239 

0.10986 

0.32743 

0.34537 

16 

-0.02930 

-0.07058 

0.07642 

0.06500 

-0.29322 

0.30034 

17 

0.32593 

-0.18253 

0.37356 

-0.47699 

-0.19053 

0.51365 

18 

-0.45135 

0.29495 

0.53918 

0.05768 

0.26217 

0.26844 

19 

-0.22797 

0.23334 

0.32621 

0.25726 

-0.32259 

0.41262 

20 

0.81482 

0.16989 

0.83234 

-0.86243 

-0.36052 

0.93475 

21 

-0.33691 

0.27610 

0.43559 

-0.47424 

0.01636 

0.47453 

22 

-0.49713 

-0.01287 

0.49730 

0.33508 

-0.06824 

0.34196 

23 

0.40100 

0.31886 

0.51232 

-0.59967 

0.01171 

0.59978 

24 

0.08881 

0.26115 

0.27384 

0.00732 

0.56970 

0.56975 

25 

-0.44952 

0.03000 

0.4565 9 

-0.07690 

-0.05411 

0.09403 

26 

-0.37354 

—0. 26644 

0.45882 

0.24445 

-0.35309 

0.42945 

27 

-0.09796 

0.36414 

0.37709 

0.81848 

-0.29322 

0.86942 

28 

0.37354 

-0.11173 

0.38989 

0.07965 

0.^2783 

0.43518 

29 

0.67566 

0.35909 

0.76515 

0.34058 

0.07693 

0.34917 

30 

-0.46326 

0.26874 

0.53556 

-0.03387 

0.34323 

0.34490 

31 

0.41565 

0.06851 

0.42126 

-1.18652 

0.08906 

1 .18986 

32 

-0.53192 

0.39633 

0.66334 

-0.01831 

—0. 36443 

0.36489 

33 

-0.17395 

-0.07540 

0.18959 

0.21790 

-0.13071 

0.25409 

34 

-0.25818 

0. 10161 

0. 27745 

-0.07233 

0.15823 

0.17398 

35 

-0.64178 

0.29173 

0.70498 

-0.43030 

0.15749 

0.45821 

36 

-0.75256 

0.13609 

0.76477 

-0.16479 

0.24748 

0.29733 

37 

0.26825 

-0.06433 

0.  27597 

0.65643 

-0.30453 

1.03835 

38 

—0.55756 

0.16253 

0.58076 

-0.23198 

-0.08739 

0.29521 

39 

-0.60883 

0.66208 

0.39945 

0.26276 

0.22405 

0.34531 

40 

0.13092 

0.35587 

0.37919 

-1.25793 

-0.15135 

1.26701 

41 

-0.09979 

-0.02851 

0.10378 

1.01257 

-0.46632 

1.11479 

42 

-0.40649 

-0.04828 

0.40935 

-0.22614 

-0.06154 

0.23436 

43 

-0.06958 

0.09081 

0.11440 

-0. 18036 

-0.49700 

0.52871 

44 

-1.16730 

-0.0259S 

1.16759 

0.35339 

-0.12681 

0.37546 

45 

0.04486 

0.34024 

0.34318 

-0.29297 

-0.01748 

0.29349 

46 

-0.32043 

0.63817 

0.71410 

-0.25818 

—0. 33654 

0.42416 

47 

-1.08307 

0.35840 

1.14083 

0.27740 

-0.41705 

0.50088 

48 

0.17578 

0.29633 

0.43356 

0.48340 

0.29545 

0.56654 

49 

0.12360 

0.04874 

0.13286 

-0.25635 

-0.07084 

0.26596 

50 

-0.61523 

0.16322 

0.63652 

-0.07416 

—0.16065 

0.17694 

AVERAGE 

ERROR  IN  NAUTICAL  MILES 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

LATITUDE 

LONGITUDE 

RANGE 

LATITUDE 

LONGITUDE 

RANGE 

RUNS 

ERROR 

•  ERROR 

ERROR 

-  ERROR 

ERROR 

ERROR 

50 

0.44852 

0.23376 

0.53692 

0.39961 

0.23108 

0.50758 
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AIRCRAFT  FLIGHT  DATA  COMPUTER  OUTPUT 
LISTING  OF  BEARING  ANGLES-OF— ARRIVAL  AND  AIRCRAFT  NAVIGATION  DATA 
N  HDGD(N)  SLADCN)  SLOD(N)  BRNGDIN)  THETAD(N)  THETA(N) 


1  135. 

2  135. 

3  135. 

4  135. 

5  135. 

6  135. 

7  135. 

8  135. 

9  135. 

10  135. 

11  135. 

12  135. 

13  135. 

14  135. 

15  135. 

16  135. 

17  135. 

18  134. 

19  131. 

20  122. 
21  120. 
22  120. 

23  120. 

24  120. 

25  120. 

26  120. 

27  121. 

28  121. 

29  121. 

30  121. 

31  120. 

32  120. 

33  121. 

34  119. 

35  120. 

36  120. 

37  121. 

38  121. 

39  120. 

40  120. 

41  120. 

42  120. 

43  119. 

44  119. 

45  118. 

46  118. 

47  118. 

48  118. 

49  118. 

50  118. 

51  119. 

52  120. 

53  120. 

54  120. 

55  120. 

56  121. 

57  121. 

58  120. 

59  120. 

60  120. 
61  121. 
62  121. 

63  121. 

64  119. 

65  119. 


52739 
64830 
48329 
41739 
31882 
30740 
00026 
06616 
28560 
51651 
61504 
56006 
49416 
43913 
3  8472 
30740 
16473 
45079 
33047 
29950 
58583 
73991 
76172 
76172 
87172 
98116 
36617 
44293 
57474 
58560 
76172 
89346 
27792 
94865 
68495 
70670 
12437 
17940 
91527 
72344 
66260 
65167 
66331 
2  7831 
99298 
83884 
71851 
74031 
72943 
82796 
64102 
40988 
64079 
65167 
88258 
12437 
22295 
21225 
75079 
77260 
01439 
15704 
15704 
75102 
79510 


33.3547 2  -120.90094  283.69995  59.22729  1.03371 
33.33582  -120.87630  282.10010  57.74829  1.00790 
33.31691  -120.  85220  286.89990  62.38306  1.08879 
33.30316  -120.83391  280.80005  56.21729  0.98118 
33.28426  -120.80925  300.99976  76.31836  1.33201 
33.28426  -120.80925  279.90015  55.20752  0.96355 
33.26993  -120.79089  278.49976  53.50000  0.93375 
33.25504  -120.77144  314.80005  89.86621  1.56846 
33.24701  -120.75996  277.30005  52.58545  0.91779 
33.23727  -120.74796  275.89966  51.41602  0.89738 
33.22752  -120.735 32  312.79980  88.41479  1.54313 
33.22353  -120.73019  277.30005  52.86011  0.92258 
33.21779  -120.72276  312.29956  87.79370  1.53229 
33.21378  -120.71753  275.40015  50.83911  0.88731 
33.20461  -120.70555  273.79980  49.18433  0.85843 
33.19380  -120.69312  311.60010  86.90747  1.51632 
33.19431  -120. 69238  311.29980  86.46436  1.50909 
33.18570  -120.63091  299.49976  73.95044  1.290b8 
33.18112  -120.67462  276.00000  47.3303 2  0.82607 
33.16908  -120.65343  291.79980  54.09912  0.94421 
33.16507  -120.64539  275.69971  36.28540  0.63330 
33.15591  -120.62419  233.30005  44.03979  0.76864 
33.15477  -120.62250  276.30005  37.06177  0.6V685 
33.15247  -120.61676  258.39990  19.16162  0.33443 
33.14347  -120.60312  275.19995  36.07153  0.62957 
33.14159  -120.59326  274.19971  35.18066  0.61402 
33.13127  -120.57091  275.09985  36.46582  0.63645 
33.12840  -120.56517  280.89950  42.34277  0.73902 
33.12154  -120.55036  308.69971  70.27441  1.22652 
33.12154  -120.55026  289.60010  51.18555  0.89336 
33.10606  -120.51649  287.60010  48.36182  0.84407 
33.10434  —120. 57  305  279.69995  40.59326  0.70849 
33.09747  -120.49373  278.29980  39.57764  0.69076 
33.08716  -120.47638  309.39990  69.34839  1.21036 
33.08028  -120.46147  287.29980  47.98462  0.83749 
33.07971  -120.45976  272.19995  32.90649  0.57433 
33.07397  -120.44055  27o. 50024  37.62451  0.65667 
33.05965  -120.41562  315.00000  76.17920  1.32958 
33.05794  -120.41278  283.39966  44.31470  0.77344 
33.05679  -120.40988  275.00000  35.72827  0.62358 
33.04991  -120.39502  306.99976  67.66235  1.18093 
33.04935  -120.39442  274.30005  34.95166  0.61002 
33.03215  -120.35721  287,19946  46.86255  0.81791 
33.02585  -120.34229  285.69995  44.97803  0.78502 
33.02184  -120.33426  312.79980  71.79272  1.25302 
33.01840  -120.32623  312.00000  70.83862  1.23637 
33.01553  -120.31995  276.50024  35.21875  0.61463 
33.00923  -120.30502  272.19995  30.94019  0.54001 
33.00522  -120.29590  311.09985  69.82910  1.21875 
33.00293  -120.28957  282.99976  41.82764  0.73003 
32.99892-120.28099  309.00000  68.64087  1.19801 
32.99261  -120.26721  271.89990  32.30957  0.56391 
32.98230  -120.24486  267.10010  27.74072  0.48417 
32.97887  -120.23804  267.00000  27.65161  0.48261 
32.97485  -120.22940  306.10034  66.98291  1.16907 
32.96855  -120.21568  266.80005  27.92432  0.48737 
32.96683  -120.21164  276.59985  37.82275  0.66013 
32.96111  -120.19908  264.00000  24.21216  0.4225S 
32.95137  -120.17842  263.39990  24.15063  0.42151 
32.95079  -120.17728  301.39966  62.17212  1.08511 
32.94391  -120.16356  277.89990  38.91406  0.67918 
32.94048  -120.156C7  298.39966  59.55664  1.03946 
32.93646  -120.14749  257.09985  18.25684  0.31864 
32.92902  -120.13258  257.00000  16.75098  0.29236 
32.92615  -120.12630  278.09985  37.89478  -0.66139 
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NTAR  =  1 

UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  1 

EMITTER  BEARING  LINES  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

1 

2872.0 

320.0 

2 

2872. 0 

322.0 

4 

2872.0 

320.0 

6 

2872.0 

318.0 

7 

2872.0 

320.0 

9 

2872.0 

319.0 

10 

2872.0 

321.0 

14 

2872.0 

320.0 

15 

2872.0 

320.0 

19 

2872.0 

320.0 

28 

2872.0 

319.0 

32 

2872.0 

319.0 

33 

2872.0 

320.0 

37 

2872.6 

320.0 

40 

2872.0 

320.0 

42 

2872.0 

320.0 

48 

2872.0 

319.0 

53 

2872.0 

323.0 

54 

2872.0 

320.0 

59 

2872.0 

322.0 

2.40  135.52739 
2.50  135.64830 
2.50  135.41739 
2.40  135.30740 
2.60  135.00026 
2.20  135.28560 
2.50  135.51651 
2.60  135.43913 
2.20  135.38472 
2.40  131.33047 
2.60  121.44293 
2.50  120.89346 
2.50  121.27792 
2.40  121.12437 
2.50  120.72844 
2.50  120.65167 
2.30  118.74031 
2.80  120.64079 
2.50  120.65167 
2.50  12  0.75079 


BRNGD  THETAD 

283.69995  59.22729 

282.10010  57.74829 
280.80005  56.21729 
279.90015  55.20752 
278.49976  53.50000 

277.30005  52.58545 
275.89966  51.41602 
275.40015  50.83911 
273.79980  49.18433 
276.00000  47.33032 
280.89990  42.34277 

279.69995  40.59326 
278.29980  39.57764 
276.50024  37.62451 
275.00000  35.72827 

274.30005  34.95166 
272.19995  30.94019 

267.10010  27.74072 
267.00000  27.65161 
263.39990  24.15063 


NTAR  =  2 


UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  2 

EMITTER  BEARING  LINES  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

PM 

HDGD 

BRNGD 

THETAD 

3 

2876.0 

306.0 

2.40 

135.48329 

286.89990 

62.38306 

20 

2878.0 

304.0 

2.40 

122.29950 

291.79980 

54.09912 

24 

2876.0 

305.0 

2.40 

120.76172 

258.39990 

19.16162 

30 

2878.0 

306.0 

2.30 

121.58560 

289.60010 

51.18555 

35 

2876.0 

306.0 

2.30 

120.68495 

287.29980 

47.98462 

43 

2876.0 

306.0 

2.40 

119.66331 

287.19946 

46.86255 

44 

2876.0 

306.0 

2.30 

119.27831 

285.69995 

44.97803 

50 

2876.0 

306.0 

2.50 

118.82796 

282.99976 

41.82764 

61 

2876.0 

306.0 

2.30 

121.01439 

277.89990 

38.91406 

65 

2876.0 

306.0 

2.40 

119.79510 

278.09985 

37. 89478 

57 


NTAR  =  3 


UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  3 

EMITTER  BEARING  LINES  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

PW 

HDGD 

BRNGD 

THETAD 

5 

2846.0 

370.0 

2.30 

135.31882 

300.99976 

76.31836 

18 

2846.0 

370.0 

2.30 

134.45079 

299.49976 

73.95044 

29 

2846.0 

370.0 

2.40 

121.57474 

308.69971 

70.27441 

34 

2846.0 

370.0 

2.40 

119.94865 

309.39990 

69.34839 

41 

2846.0 

370.0 

2.40 

120.66260 

306.99976 

67.66235 

NTAR  =  4 


UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  4 

EMITTER  BEARING  LINES  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

PM 

HDGD 

BRNGD 

THETAD 

8 

5556.0 

320.0 

1.00 

135.06616 

314.80005 

89.86621 

13 

5554.0 

640.0 

1.10 

135.49416 

312.29956 

87.79370 

16 

5556.0 

320.0 

1.00 

135.30740 

311.60010 

86.90747 

23 

5556.0 

640.0 

1.00 

120.76172 

276.30005 

37.06177 

25 

5556.0 

320.0 

1.10 

120.87172 

275.19995 

36.07153 

27 

5554.0 

640.0 

1.10 

121.36617 

275.09985 

36.46582 

36 

5554.0 

640.0 

1.10 

120.70670 

272.19995 

32.90649 

46 

5554.0 

640.0 

0.90 

118.83884 

312.00000 

70.83862 

49 

5554.0 

320.0 

1.00 

118.72943 

311.09985 

69.82910 

58 

5556.0 

640.0 

1.00 

120.21225 

264.00000 

24.21216 

63 

5556.0 

640.0 

1.00 

121.15704 

257.09985 

18.25684 

64 

5556.0 

320.0 

1.10 

119.75102 

257.00000 

16.75098 

UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  5 

EMITTER  BEARING  LINES  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

PW 

HDGD 

BRNGD 

THETAD 

11 

5506.0 

640.0 

0.60 

135.61504 

312.79980 

88.41479 

17 

5504.0 

640.0 

0.60 

135.16473 

311.29980 

86.46436 

21 

5504.0 

640.0 

0.60 

120.58583 

275.69971 

36.28540 

26 

5504.0 

640.0 

0.60 

120.98116 

274.19971 

35.18066 

38 

5504.0 

640.0 

0.60 

121.17940 

315.00000 

76.17920 

45 

5506.0 

640.0 

0.70 

118.99298 

312.79980 

71.79272 

51 

5504.0 

642.0 

0.60 

119.64102 

309.00000 

68.64087 

55 

5504.0 

640.0 

0.60 

120.88258 

306.10034 

66.98291 

60 

5504.0 

642.0 

0.60 

120.77260 

301.39966 

62.17212 

NTAR  =  6 


UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  6 

EMITTER  BEARING  LINES  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

PW 

HDGD 

BRNGD 

THETAD 

12 

2876.0 

359.0 

2.20 

135.56006 

277.30005 

52.86011 

22 

2876.0 

359.0 

2.20 

120.73991 

283.30005 

44.03979 

47 

2876.  0 

359.0 

2.40 

118.71851 

276.50024 

35.21875 

52 

2874.0 

359.0 

2.40 

120.40988 

271.89990 

32.30957 

56 

2876.0 

359.0 

2.20 

121.12437 

266.80005 

27.92432 

62 

2874.0 

359.0 

2.40 

121.15704 

298.39966 

59.55664 

NTAR  =  7 


UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  7 

EMITTER  BEARING  LINES  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

PW 

HDGD 

BRNGD 

THETAD 

31 

9268.0 

500.0 

0.20 

120.76172 

287.60010 

48.36182 

39 

9268.0 

499.0 

0.20 

120.91527 

283.39966 

44.31470 

57 

9270.0 

500.0 

0.30 

121.22295 

276.59985 

37.82275 

INITIAL  JSET  DATA 


JSETC1 

JSET  ( 1 

JSETd 

JSET ( 1 

JSETd 

JSETd 

JSETd 

JSETd 

JSET(1 

JSETd 

JSETd 

JSETd 

JSET(1 

JSETd 

JSET  ( 1 

JSETd 

JSET(1 

JSETd 

JSETd 

JSETd 

JSETd 

JSET (2 

JSETC2 

JSETd 

JSETd 

JSETd 

JSETd 

JSET  { 2 

JSETd 

JSET  ( 2 

JSETd 

JSETd 

JSETd 

JSETd 

JSETd 

JSET ( 4 

JSET (4 

JSETd 

JSET ( 4 

JSET (4 

JSET( 4 

JSET (4 

JSET  (4 

JSET(  4 

JSET (4 

JSET  ( 4 

JSETd 

JSET ( 5 

JSETd 

JSET( 5 

JSET (5 

JSET ( 5 

JSETd 

JSET ( 5 

JSET{5 

JSET( 5 

JSET (6 

JSET ( 6 

JSET( 6 

JSET (6 

JSET( 6 

JSET( 6 

JSET (7 

JSET ( 7 

JSETd 


1)  = 
2 )  = 

3)  = 

4 )  = 

5 )  = 
61  = 


1 

2 

4 

6 

7 

9 


7  )=  10 

i  8) =  14 

9)  =  15 

10)=  19 

►i  i: 

=  28 

12 

=  32 

13 

=  33 

14; 

=  37 

15 

=  40 

16 

=  42 

17; 

=  48 

18; 

=  53 

19 

=  54 

2  0  J 

=  59 

1] 

=  3 

2; 

=  20 

3] 

=  24 

4] 

=  30 

5; 

=  35 

6] 

=  43 

7 

=  44 

8 

=  50 

9] 

=  61 

10 

=  65 

1J 

=  5 

2] 

=  18 

3] 

=  29 

4] 

=  34 

5  J 

=  41 

1 

=  8 

21 

=  13 

3) 

=  16 

4 

=  23 

5) 

=  25 

6) 

=  27 

7 

=  36 

8) 

=  46 

9) 

=  49 

10 

=  58 

11 

=  63 

12) 

=  64 

1 

=  11 

2) 

=  17 

3) 

=  21 

4 

=  26 

5) 

=  38 

6) 

=  45 

7 

=  51 

8) 

=  55 

9 

=  60 

1 

=  12 

2) 

=  22 

3) 

=  47 

4 

=  52 

5 

=  56 

6) 

=  62 

1 

=  31 

2 

=  39 

3) 

=  57 
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LISTING  OF  KALMAN  FILTER  PARAMETERS 


I 

J 

KK 

K 

G1(K ) 

G2(  K ) 

T(K) 

E(K) 

GATE(K) 

1 

1 

0 

1 

0.98580 

0.0 

0.0 

1 

2 

1 

2 

0.99996 

0.05132 

19.48511 

-0.54543 

974.29150 

1 

3 

2 

4 

0.91370 

0.01972 

34.17871 

1.06322 

20.  42409 

1 

4 

4 

6 

0.66077 

0.01124 

19.57300 

0.15733 

10.30163 

1 

5 

6 

7 

0.51469 

0.00771 

14.74170 

-0.87030 

8.61279 

1 

6 

7 

9 

0.50206 

0.00621 

24.46582 

0.12813 

8.50278 

1 

7 

9 

10 

0.38820 

0.00452 

9.74414 

-0.52989 

7.67091 

1 

8 

10 

14 

0.39830 

0.00402 

24.43945 

0.60146 

7.73504 

1 

9 

14 

15 

0.32591 

0.00314 

9.80640 

-0.71368 

7.30789 

1 

10 

15 

19 

0.33848 

0.00292 

24.56360 

-0.82887 

7.37700 

1 

11 

19 

28 

0.50143 

0.00304 

73.93848 

-0.82394 

8.49747 

1 

12 

28 

32 

0.44026 

0.00291 

34.57788 

0.12999 

8.01970 

1 

13 

32 

33 

0.33461 

0.00230 

9.  83130 

-0.29539 

7.35553 

1 

14 

33 

37 

0.35500 

0.00256 

34.44116 

0.14192 

7.  47088 

1 

15 

37 

40 

0.33730 

0.00245 

24.61328 

-0.17593 

7.37042 

1 

16 

40 

42 

0.28037 

0.00206 

9.84668 

-0.23737 

7.07287 

1 

17 

42 

48 

0.39363 

0.00255 

58.93970 

-0.22783 

7.70516 

1 

18 

48 

53 

0.40188 

0.00270 

39.44409 

-0.66829 

7.75814 

1 

19 

53 

54 

0.30055 

0.00205 

4.93677 

-0. 14583 

7.17417 

1 

20 

54 

59 

0.34579 

0.00244 

39.42358 

-0.85219 

7.41809 

2 

1 

0 

3 

0.98580 

0.0 

0.0 

2 

2 

3 

20 

1.00000 

0.00638 

156.82422 

-0.86391 

7841.21484 

2 

3 

20 

24 

0.61665 

0.00505 

24.59717 

-33.63820 

9.69064 

2 

3 

20 

30 

0.78886 

0.00532 

69. 00879 

0.73169 

13.05779 

2 

4 

30 

35 

0.66823 

0.00511 

59.16089 

-0.15179 

10.41681 

2 

5 

35 

43 

0.65760 

0.00443 

68,85083 

2.24968 

10.25372 

2 

6 

43 

44 

0.42984 

0.00306 

9.78320 

-0.72655 

7. 94606 

2 

7 

44 

50 

0.42162 

0.00325 

34.46094 

-2.  12259 

7.88938 

2 

8 

50 

61 

0.58649 

0.00358 

83.76660 

-0.05772 

9.33059 

2 

9 

61 

65 

0.44875 

0.00309 

24. 76538 

0.16925 

8.08118 

3 

1 

0 

5 

0.98580 

0.0 

0.0 

3 

2 

5 

18 

1.00000 

0.00972 

102.83667 

1.98647 

5141.83984 

3 

3 

18 

29 

0.82455 

0.00552 

88.72338 

-1.63304 

14. 32434 

3 

4 

29 

34 

0.62591 

0.00437 

49.30444 

0.36708 

9.80986 

3 

5 

34 

41 

0.57737 

0.00393 

54.13794 

0.09885 

9.22935 

4 

1 

0 

8 

0.98580 

0.0 

0.0 

4 

2 

8 

13 

0.99999 

0.02562 

39.03418 

-0.70366 

1951.72705 

4 

3 

13 

16 

0.71699 

0.01466 

19.63843 

0.  15646 

11.27851 

4 

4 

16 

23 

0.79911 

0.00917 

54.08618 

-47.05379 

13.38674 

4 

4 

16 

25 

0.83155 

0.00864 

63.97461 

-47.54167 

14.61884 

4 

4 

16 

27 

0.88655 

0.00742 

83.63501 

-45.89  462 

17.  81369 

4 

4 

16 

36 

0.95376 

0.00498 

162.59375 

-45.69676 

27.90096 

4 

4 

16 

46 

0.97787 

0.00351 

251.06714 

-3.27011 

40.32851 

4 

5 

46 

49 

0.56372 

0.00543 

19.68750 

0. 14413 

9.08385 

4 

6 

49 

58 

0.74102 

0.00787 

64.11743 

-41.61142 

11.79007 

4 

6 

49 

63 

0.84422 

0.00683 

98.53325 

-45.4474 2 

15.20187 

4 

6 

49 

64 

0.86349 

0.00651 

103.48877 

-46.34418 

16.23961 

5 

1 

0 

11 

0.98580 

0.0 

0.0 

5 

2 

11 

17 

0.99999 

0.02916 

34.29346 

-0.70633 

1714.69336 

5 

3 

17 

21 

0.83310 

0.01454 

34.41162 

-48.22182 

14.68663 

5 

3 

17 

26 

0.92856 

0.01037 

68.95825 

-47.36174 

22.44804 

5 

3 

17 

38 

0.98610 

0.00473 

187.19775 

0.  36156 

50.88951 

5 

4 

38 

45 

0.69876 

0.00599 

54.06836 

-1.39986 

10.93197 

5 

5 

45 

51 

0.57013 

0.00525 

34.47925 

-1.38312 

9.15131 

5 

6 

51 

55 

0.51924 

0.00459 

34.46753 

0.  18741 

8.65340 

5 

7 

55 

60 

0.48515 

0.00395 

34.52881 

-2.30612 

8.36201 

6 

1 

0 

12 

0.98580 

0.0 

0.0 

6 

2 

12 

22 

1.00000 

0.01272 

78.58911 

-4.96594 

3929.46289 

6 

3 

22 

47 

0.95323  • 

0.00368 

201.91919 

13.84093 

27.74507 

6 

4 

47 

52 

0.61332 

0.00567 

34.48828 

-0.14958 

9.64890 

6 

5 

52 

56 

0.56416 

0.00613 

34.49512 

-2.30110 

9.08843 

6 

6 

56 

62 

0.56612 

0.00549 

39.41577 

33.63329 

9.10896 

7 

1 

0 

31 

0.98580 

0.0 

0.0 

7 

2 

31 

39 

1.00000 

0.01452 

68.88379 

-0.75569 

3444.19727 

7 

3 

39 

57 

0.91990 

0.00521 

132.89380 

1.31592 

21.20036 
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FINAL  JSET  DATA 


JSET (1 

JSET(1 

JSETd 

JSFT(1 

JSETd 

JSET ( i 

JSETd 

JSETd 

JSETd 

JSETd 

JSETd 

JSET ( 1 

JSETd 

JSETd 

JSETd 

JSETd 

JSETd 

JSETd 

JSETd 

JSETd 

JSET ( 2 

JSET (2 

JSETd 

JSET  2 

JSET (2 

JSET12 

JSET  2 

JSETd 

JSET  2 

JSET (3 

JSET (3 

JSETd 

JSETd 

JSET  3 

JSET  4 

JSET (4 

JSETI4 

JSET  4 

JSET  (4 

JSET  5 

JSETd 

JSETd 

JSETd 

JSETd 

JSET  d  i 

JSET  5 

JSET  6i 

JSET  6 

JSET  6 

JSET  6 

JSET<6 

JSET(7 

JSET(7, 

JSET (7 ( 


1)=  1 
2  =  2 

3)  =  4 

4=6 

5)  =  7 

6  =  9 

7 10 

8)  =  1* 

9)  =  15 

10) =  19 

11) =  28 

12) =  32 

13) =  33 

14) =  37 

15  =  40 

16  =  42 
17)=  48 

18  =  53 

19  =  54 
20)=  59 

1) =  3 

2)  =  20 

3)  =  30 

4)  =  35 
5  =  43 

6)  =  44 

7) =  50 

8)  =  61 

9)  =  65 
1=5 
2  =  18 

3)  =  29 

4 )  =  34 

5) =  41 

1)=  8 

2  )=  13 

3 )  =  16 

4  =  46 

5  )=  49 
1)=  11 

2)  =  17 

3  =  38 

4)  =  45 

5  =  51 

6  =  55 
7)  =  60 
1)=  12 
2  )=  22 

3 )  =  47 

4)  =  52 

5) =  56 

1)  =  31 

2)  =  39 

3 )  =  57 
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NTAR  =  1 


FILTERED  AND 

SMOOTHED 

EMITTER 

TARGET  DATA 

CORRELATED 

TO  NTAR  = 

NUM 

FREQ 

PRF 

PW 

THETAD 

THTD 

THTD1 

1 

2872.0 

320.0 

2.40 

59.22729 

59.22729 

59.22729 

2 

2872. 0 

322.0 

2.50 

57.74829 

57.74831 

59.22726 

4 

2872.0 

320.0 

2.50 

56.21729 

56.12552 

59.07391 

6 

2872.0 

318.0 

2.40 

55.20752 

55.15414 

59.04889 

7 

2872.0 

320.0 

2.60 

53. 50000 

53.92235 

59.18648 

9 

2872.0 

319.0 

2.20 

52.58545 

52.52164 

59.16264 

10 

2872.0 

321.0 

2.50 

51.41602 

51.74019 

59.24341 

14 

2872.0 

320.0 

2.60 

50.83911 

50.47720 

59.14085 

15 

2872.0 

320.0 

2.20 

49.18433 

49.66541 

59.24278 

19 

2872.0 

320.0 

2.40 

47.33032 

47.87863 

59.36894 

28 

2872.0 

319.0 

2.60 

42.34277 

42.75356 

59.51895 

32 

2872.0 

319.0 

2.50 

40.59326 

40.52049 

59.50125 

33 

2872.0 

320.0 

2.50 

39.57764 

39.77419 

59.53  006 

37 

2872.0 

320.0 

2.40 

37.62451 

37.53296 

59.51884 

40 

2872.0 

320.0 

2.50 

35.72827 

35.84486 

59.52922 

42 

2872.0 

320.0 

2.50 

34.95166 

35.12247 

59.53961 

48 

2872.0 

319.0 

2.30 

30.94019 

31.07832 

59.54620 

53 

2872.0 

323.0 

2.80 

27.74072 

28.14043 

59.55690 

54 

2872.0 

320.0 

2.50 

27.65161 

27.75360 

59.55846 

59 

2872.0 

322.0 

2.50 

24.15063 

24.70815 

59.56096 

oMOGTHED  INITIAL  BEARING  ANGLE  =  59.56096 

FILTERED  FINAL  BEARING  ANGLE  =  24.70815 

PLANE  TRI ANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  33  .98666N 


EMITTER  LONGITUDE  =-119.60387W 


/ 


NTAR  =  2  / 


=ILTERED  AND 

SMOOTHED 

EMITTER 

TARGET/AT 

A  CORRELATED 

TO  NTAR  = 

NUM 

FREQ 

PRF 

PW 

THETAD 

THTD 

THTD1 

3 

2876.0 

306.0 

2.40 

62.38306 

62.38306 

62.38306 

20 

2878.0 

304.0 

2.40 

54.09912 

54.09912 

62.38306 

30 

2878.0 

306.0 

2.30 

51.18555 

51.03105 

62.29199 

35 

2876.0 

306.0 

2.30 

47.98462 

48.03497 

62.32124 

43 

2876.0 

306.0 

2.40 

46.86255 

46.09224 

61.92072 

44 

2876.0 

306.0 

2.30 

44.97803 

45.39227 

62.00427 

50 

2876.0 

306.0 

2.50 

41.82764 

43.05530 

62.22186 

61 

2876.0 

306.0 

2.30 

38.91406 

38.93793 

62.22676 

65 

2876.0 

306.0 

2.40 

37.89478 

37.80147 

62.21768 

SMOOTHED  INITIAL  BEARING  ANGLE  =  62.21768 

FILTERED  FINAL  BEARING  ANGLE  =  37.80147 

PLANE  TRIANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  34.12234N 

EMITTER  LONGITUDE  =-119.00533W 


67 


NTAR  =  3 


-'ILTERED  AND  SMOOTHED  EMITTER  TARGET  DATA  CORRELATED  TO  NTAR  =  3 


MUM 

FREQ 

PRF 

PW 

THETAD 

THTD 

THTD1 

5 

2846.0 

370.0 

2.30 

76.31836 

76.31836 

76.31  836 

18 

2846.0 

370.0 

2.30 

73.95044 

73.95042 

76.31836 

29 

2846. 0 

370.0 

2.40 

70.27441 

70.56093 

76.49266 

34 

2846.0 

370.0 

2.40 

69.34839 

69.21106 

76.45313 

41 

2846.0 

370.0 

2.40 

67.66235 

67.62057 

76.44316 

SMOOTHED  INITIAL  BEARING  ANGLE  =  76.44316 

FILTERED  FINAL  BEARING  ANGLE  =  67.62057 

PLANE  TRI ANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  33.81570N 

EMITTER  LONGITUDE  =-118.15642W 
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NTAR  =  4 


FILTERED  AND 

SMOOTHED 

EMITTER 

TARGET  DATA 

CORRELATED 

TO  NTAR  = 

NUM 

FREQ 

PRF 

PW 

THETAD 

THTD 

THTD1 

8 

5556.0 

320.0 

1.00 

89.86621 

89.86621 

89.86621 

13 

5554.0 

640.0 

1.10 

87.79370 

87.79370 

89.86620 

16 

5556.0 

320.0 

1.00 

86.90747 

86.86319 

89.  84418 

46 

5554.0 

640.0 

0.90 

70.83862 

70.91100 

90.19023 

49 

5554.0 

320.0 

1.00 

6S.  82910 

69.  76620 

90.18146 

SMOOTHED  INITIAL  BEARING  ANGLE  =  90.18146 

FILTERED  FINAL  BEARING  ANGLE  =  69.76620 

PLANE  TRIANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  33.25166N 

EMITTER  LONGITUDE  =-119.49638W 


a 


NTAR  =  5 


FILTERED  AND 

SMOOTHED 

EMITTER 

TARGET  DATA 

CORRELATED 

TO  NTAR  = 

NUM 

FREQ 

PRF 

PW 

THETAD 

THTD 

THTD1 

11 

5506.0 

640.0 

0.60 

88.41479 

88.41479 

88.41479 

17 

5504.0 

640.0 

0.60 

86.46436 

86.46436 

88.41478 

38 

5504.0 

640.0 

0.60 

76.17920 

76.17416 

88.38852 

45 

5506.0 

640.0 

0.70 

71.79272 

72.21440 

88.49161 

51 

5504.0 

6.42.0 

0.60 

68.64087 

69.23541 

88.57  054 

55 

5504.0 

640.0 

0.60 

66.98291 

66.89281 

88.56223 

60 

5504.0 

642.0 

0.60 

62.17212 

63.35942 

88.63921 

SMOOTHED  INITIAL  BEARING  ANGLE  =  83.63921 

FILTERED  FINAL  BEARING  ANGLE  =  63.35942 

PLANE  TRIANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  33.25288N 

EMITTER  LONGITUDE  =-ll9.45715W 
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NTAR 


6 


FILTERED  AND 

SMOOTHED 

EMITTER 

TARGET  DATA 

CORRELATED 

TO  NTAR  = 

NUM 

FREQ 

PRF 

PW 

THETAD 

THTD 

THTD1 

12 

2876.0 

359.0 

2.20 

52.86011 

52.86011 

52.86011 

22 

2876.0 

359.0 

2.20 

44.03979 

44.03979 

52.86009 

47 

2876.0 

359.0 

2.40 

35.21875 

34.57146 

52.04729 

52 

2874.0 

359.0 

2.40 

32.30957 

32.36740 

52.05992 

56 

2876.0 

359.0 

2.20 

27.92432 

28.92722 

52.26216 

SMOOTHEO  INITIAL  BEARING  ANGLE  =  52.26216 

FILTERED  FINAL  BEARING  ANGLE  =  28.92722 

PLANE  TRIANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  33.99094N 

EMITTER  LONGITUDE  =-119.53415W 
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N'  -  R 


7 


FILTERED  AND 

SMOOTHED 

EMITTER 

TARGET  DATA 

CORRELATED 

TO  NTAR  = 

NUM 

FREQ 

PRF 

PW 

THETAD 

THTO 

THTD1 

31 

9268.0 

500.0 

0.20 

48.36182 

48.36182 

48.36182 

39 

9268.0 

499.0 

0.20 

44.31470 

44.31470 

48.36180 

57 

9270.0 

500.0 

0.30 

37.82275 

37.71735 

48.22450 

SMOOTHED  INITIAL  BEARING  ANGLE  =  48.22450 

FILTERED  FINAL  BEARING  ANGLE  =  37.71735 

PLANE  TRI ANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  34.14626N 

EMITTER  LONGITUDE  =-119.10936W 


MONTE  CARLO  SIMULATION  COMPUTER  OUTPUT 


LISTING  OF  BEARING  ANGLES-OF-ARRI VAL  AND  AIRCRAFT  NAVIGATION  DATA 


N  HDGD(N)  SLAD(N)  SLOD(N)  BRNGDINI  THETAO(N)  THETA(N) 


1  180.00000  33.50000  -118, 50000  105.98349  105.22139  1.83646 

2  180.00000  33.48332  -118.50000  123.17577  122.24252  2.13353 

3  180.00000  33.46666  -118. 50000  104.01610  104.94077  1.83156 

4  180.00000  33.45000  -118.50000  121.91071  122.29161  2.13439 

5  180.00000  33.43332  -118.50000  102.01436  102.3b406  1.78659 

6  180.00000  33.41666  -118.50000  120.60915  120.92984  2.11062 

7  180.00000  33.39999  -118.50000  99.98351  98.88550  1.72588 

8  180.00000  33.38332  -118.50000  119.27164  119.94717  2.09347 

9  180.00000  33.36667  -118.50000  97.92696  99.2920 8  1.73297 

10  180.00000  33.34999  -118.50000  117.69893  119.21582  2.08071 

11  180.00000  33.33333  -118.50000  95.84862  95.14084  1.66052 

12  180.00000  33.31667  -118.50000  116.49051  117.06377  2.04315 

13  180.00000  33.29999  -118.50000  93.75478  94.13567  1.64298 

14  180.00000  33.23333  -118.50000  115.04587  116.65103  2.03594 

15  180.00000  33.26666  -118.50000  91.65182  92.50012  1.61443 

16  180.00000  33.25000  -118.50000  113.56721  112.34731  1.96083 

17  180.00000  33.23332  -113.50000  89.54355  89.34970  1.55945 

18  180.00000  33.21666  -118.50000  112.05394  112.10175  1.95654 

19  180.00000  33.20000  -118.50000  87.43718  83.07285  1.53716 

20  180.00000  33.18332  -116.50000  110.50731  109.82207  1.91676 

21  180.00000  33.16666  -118.50000  85.33707  85.69966  1.49574 

22  180.00000  33.14999  -118.50000  108.92969  108.74931  1.89803 

23  180.00000  33.13332  -118.50000  83.24927  83.28149  1.45354 

24  180.00000  33.11667  -118.50000  107.32155  105.82967  1.84708 

25  180.00000  33.09999  -118.50000  81.18033  81.26472  1.41834 

26  180.00000  33.08333  -118.50000  105.63427  106.09219  1.85166 

27  180.00000  33.06667  -118.50000  79.13434  79.86276  1.39357 

28  180.00000  33.04999  -118.50000  104.02003  104.02385  1.81556 

29  180.00000  33.03333  -113.50000  77.11496  77.43318  1.35146 

30  180.00000  33.01666  -116.50000  102.33 228  100.94*79  1.76152 

31  180.000 00  33.00000  -118.50000  75.12862  73.85582  1.28903 

32  180.00000  32.98332  -118.50000  lOu. 62157  101.37944  1.76940 

33  180.00000  32.96666  -118.50000  73.17722  72.90050  1.27235 

34  180.00000  32.95000  -118.50000  98.89243  98.43813  1.71807 

35  180.00000  32.93332  -116.5C000  71.26514  72.60910  1.26727 

36  180.00000  32.91666  -118.50C00  97.145S6  96.18474  1.67874 

37  180.00000  32.89999  -118.50000  69.39635  67.66759  1.18102 

38  180.00000  32.88332  -118.50000  95.38602  96.01830  1.67583 

•39  180.00000  32.86667  -118.50000  67.57230  65.77695  1.14806 

40  180.00000  32.64999  -118.50000  93.61652  93.04437  1.62393 

41  180.00000  32.83333  -113.50000  65.79401  66.04026  1.15262 

42  180.00000  32.81667  -118.50000  91.84023  90.44980  1.57365 

43  130.00000  32.79999  -118.50000  64.06415  64.31984  1.12259 

44  180.00000  32.78333  -118.50000  90.05963  90.87807  1.58612 

45  180.00000  32.76666  -118.50000  62.38416  62.62923  1.09309 

46  180.00000  32.75000  -11S. 50000  88.27945  87.30681  1.53252 

47  180.00000  32.73332  -113.50000  60.75365  61.49763  1.07334 

48  180.00000  32.71666  -113.50000  86.50214  85.91864  1.49956 

49  180.00000  32.70000  -118.50000  59.17412  59.35091  1.03587 

50  180.00000  32.68332  -116.50000  84.73131  84.47925  1.47444 

51  180.00000  32.66666  -118.50000  57.64409  58.88116  1.02767 

52  180.00000  22.64999  -118.50000  82.97147  82.71225  1.44360 

53  180.00000  32.6333 2  -113.50000  56.16422  55.42735  0.96739 

54  180.00000  32.61667  -113.50000  81.22481  81.17096  1.41670 

55  180.00000  32.59999  -118. 50000  54.73453  53.34729  0.93109 

56  180.00000  32.58333  -118.50000  79.49355  81.11581  1.41574 

57  180.00000  32.56667  -118.50000  53.35355  53.39183  0.93186 

58  180.00000  32.54999  -11S.50000  77.78148  77.89078  1.35945- 

59  180.00000  32.53333  -113.50000  52.01973  52.08127  0.90899 

60  180.00000  32.51666  -118.50000  76.09212  75.29662  1.31417 

61  180.00000  32.50000  -118.50000  50.73331  51.08221  0.89155 


NTAR  =  1 


UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  1 

EMITTER  BEARING  LINES  OF  SIMILAR  FRSviENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

PW 

HDGD 

BRNGD 

THETAD 

1 

1197.0 

150.0 

3.50 

180.00000 

105.98349 

105.22139 

3 

1197.0 

150.0 

3.50 

180.00000 

104.01610 

104.94077 

5 

1197.0 

150.0 

3.50 

180.00000 

102.01436 

102.36406 

7 

1197.0 

150.0 

3.50 

180.00000 

99.58351 

98.  88550 

9 

1197.0 

150.0 

3.50 

180.00000 

97.92696 

99.29208 

11 

1197.0 

150.0 

3.50 

180.00000 

95.84862 

95.14084 

13 

1197.0 

150.0 

3.50 

180.00000 

93.75478 

94.13567 

15 

1197.0 

150.0 

3.50 

180.00000 

91.65182 

92.50012 

17 

1197.0 

150.0 

3.50 

ISO. 00000 

89.54355 

89.34970 

19 

1197.0 

150.0 

3.50 

180.00000 

87.43718 

88.07285 

21 

1197.0 

150.0 

3.50 

130.00000 

85.33707 

85.69966 

23 

1197.0 

150.0 

3.50 

180. 00000 

83.2^927 

83.28149 

25 

1197.0 

150.0 

3.50 

160.00000 

81.18033 

81.26472 

27 

1197.0 

150.0 

3.50 

180.0C000 

79.13434 

79.86276 

29 

1197.0 

150.0 

3.50 

18  0.00000 

77.11496 

77.43318 

31 

1197.0 

150.0 

3.50 

180.00000 

75.12862 

73.85582 

33 

1197.0 

150.0 

3.50 

180.00000 

73.17722 

72.90050 

35 

1197.0 

150.0 

3.50 

180.00000 

71.26514 

72.60910 

37 

1197.0 

150.0 

3.50 

180.00000 

69.39635 

67.66759 

39 

1197.0 

150.0 

3.50 

180.00000 

67.57230 

65.77895 

41 

1197.0 

150.0 

3.50 

180.00000 

65.79401 

66.04028 

43 

1197.0 

150.0 

3.50 

180.00000 

64.06415 

64.31984 

45 

1197.0 

150.0 

3.50 

180.00000 

62.38416 

62.62923 

47 

1197.0 

150.0 

3.50 

180.00000 

60.75365 

61.49768 

49 

1197.0 

150.0 

3.50 

180.00000 

59.17412 

59.35091 

51 

1197.0 

150.0 

3.50 

180.00000 

57.64409 

58.88116 

53 

1197.0 

150.0 

3.50 

160.00000 

56. 16422 

55.42735 

55 

1197.0 

150.0 

3.50 

180.00000 

54.73453 

53.34729 

57 

1197.0 

150.0 

3.50 

130.00000 

53.35355 

53.39183 

59 

1197.0 

150.0 

3.50 

180.00000 

52.01973 

52.08127 

61 

1197.0 

150.0 

3.50 

180.00000 

50.73331 

51.08221 

NTAR  =  2 

UNFILTERED  EMITTER  TARGET  DATA  INITIALLY  ASSOCIATED  TO  NTAR  =  2 

EMITTER  BEARING  LINES  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE 


NUM 

FREQ 

PRF 

PW 

HDGD 

BRNGD 

THETAD 

2 

1212.0 

250.0 

3.00 

180.00000 

123.17577 

122.24252 

4 

1212.0 

250.0 

3.00 

180.00000 

121.91071 

122.29161 

6 

1212.0 

250.0 

3.00 

180.00000 

120.60915 

120.92984 

8 

1212.0 

250.0 

3.00 

180.00000 

119.27164 

119.94717 

10 

1212.0 

250.0 

3.00 

180.00000 

117.89893 

119.21582 

12 

1212.0 

250.0 

3.00 

180.00000 

116.49051 

117.06377 

14 

1212.0 

250.0 

3.00 

180.00000 

115.  04587 

116.65103 

16 

1212.0 

250.0 

3.00 

180.00000 

113.56721 

112.34737 

18 

1212.0 

250.0 

3.00 

180.00000 

112.05394 

112.10175 

20 

1212.0 

250.0 

3.00 

180.00000 

110.50731 

109.82207 

22 

1212.0 

250.0 

3.00 

180.00000 

108.92969 

108.74931 

24 

1212.0 

250.0 

3.00 

180.00000 

107.32155 

105.82967 

26 

1212.0 

250.0 

3.00 

180.00000 

105.68427 

106.09219 

28 

1212.0 

250.0 

3.00 

180.00000 

104.02003 

104.02385 

30 

1212.0 

250.0 

3.00 

180.00000 

102.33228 

100.94479 

32 

1212.0 

250.0 

3.00 

180.00000 

100.62157 

101.37944 

34 

1212.0 

250.0 

3.00 

180.00000 

98.89243 

98.43813 

36 

1212.0 

250.0 

3.00 

180.00000 

97.  14586 

96.18474 

38 

1212.0 

250.0 

3.00 

180.00000 

95.38602 

96.  01830 

40 

1212.0 

250.0 

3.00 

180.00000 

93.61652 

93.04437 

42 

1212.0 

250.0 

3.00 

180.00000 

91.84023 

90.44980 

44 

1212.0 

250.0 

3.00 

180.00000 

90.05968 

90.87807 

46 

1212.0 

250.0 

3.00 

180.00000 

88.27945 

87.80681 

48 

1212.0 

250.0 

3.00 

180.00000 

86.50214 

85.91864 

50 

1212.0 

250.0 

3.00 

180.00000 

84.73131 

84.47925 

52 

1212.0 

250.0 

3.00 

180.00000 

82.97147 

82.7122  5 

54 

1212.0 

250.0 

3.00 

180.00000 

31.22481 

81. 17096 

56 

1212.0 

250.0 

3.00 

180.0C000 

79.49355 

81.11531 

58 

1212.0 

250.0 

3.00 

180.00000 

77.78148 

77.  89073 

60 

1212.0 

250.0 

3.00 

180.00000 

76.09212 

75.29662 

75 


INITIAL  JSET  DATA 


JSETd,  1) 
JSET( It  2) 
JSETd,  3 J 
JSETd,  4) 
JSETd,  5) 
JSETd,  6) 
JSETd,  7) 
JSETd,  8) 
JSET  Cl,  9) 
JSETd, 10)  = 
JSETd, 11)  = 
JSETd, 12)  = 
JSET(1, 13)= 
JSET  1,14)  = 
JSET  1,15)= 
JSET  1,16)= 
JSET  1,17)  = 
JSETd. 18)  = 
JSETd, 19)  = 
JSETd, 20)  = 
JSETd, 21)  = 
JSETd, 22)  = 
JSETd, 23)  = 
JSETd,  24  = 
JSETd, 25)  = 
JSETd, 26)  = 
JSETd, 27)  = 
JSETd, 28)  = 
JSETd, 29)  = 
JSETd, 30)  = 
JSETd, 31)  = 
JS|T(2,  1)= 
JSET{2,  2)= 
JSET  2,  3) = 
JSET( 2,  4)= 
JSET { 2 ,  5 ) = 
JSET (2,  6) = 
JSET { 2,  7)= 
JSET (2 ,  8 ) = 
JSET  2,  9) = 
JSET(2,10)= 
JSET  2,11)= 
JSET( 2,12)= 
JSET(2,13)= 
JSET  2,14)= 
JSET(2,15)= 
JSET  2,16)= 
JSET (2,17)= 
JSET( 2,18)= 
JSET(2,19)= 
JSET (2 ,2  0)  = 
JSET(2,21)= 
JSET (2, 22 )= 
JSETd  ,23 )  = 
JSET(2,24)  = 
JSET(2,25)= 
JSET(2,26)= 
JSET  2,27)= 
JSET (2,28)= 
JSET(2,29)= 
JSET(  2, 30)  = 


1 

3 

5 

7 

9 

11 

13 

15 

17 

19 

21 

23 

25 

27 

29 

31 

33 

35 

37 

39 

41 

43 

45 

47 

49 

51 

53 

55 

57 

59 

61 

2 

4 

6 

8 

10 

12 

14 

16 

18 

20 

22 

24 

26 

28 

30 

32 

34 

36 

38 

40 

42 

44 

46 

48 

50 

52 

54 

56 

58 

60 


LISTING  OF  KALMAN  FILTER  PARAMETERS 


I 

J 

KK 

K 

G1(K) 

1 

1 

0 

1 

0.99010 

1 

2 

1 

3 

0.99993 

1 

3 

3 

5 

0.83379 

1 

4 

5 

7 

0.70240 

1 

5 

7 

9 

0.60715 

1 

6 

9 

11 

0.53905 

1 

7 

11 

13 

0.49142 

1 

8 

13 

15 

0.45945 

1 

9 

15 

17 

0.43927 

1 

10 

17 

19 

0.42756 

1 

11 

19 

21 

0.42147 

1 

12 

21 

23 

0.41871 

1 

13 

23 

25 

0.41768 

1 

14 

25 

27 

0.41740 

1 

15 

27 

29 

0.4173  7 

1 

16 

29 

31 

0.41737 

1 

17 

31 

33 

0.41734 

1 

18 

33 

35 

0.41729 

1 

19 

35 

37 

0.41724 

1 

20 

37 

39 

0.41720 

1 

21 

39 

41 

0.41716 

1 

22 

41 

43 

0.41716 

1 

23 

43 

45 

0.41715 

l 

24 

45 

47 

0.41715 

1 

25 

47 

49 

0.41714 

1 

26 

49 

51 

0.41714 

1 

27 

51 

53 

0.41714 

1 

28 

53 

55 

0.41714 

1 

29 

55 

57 

0.41714 

1 

30 

57 

59 

0.41714 

1 

31 

59 

61 

0.41714 

2 

1 

0 

2 

0.99010 

2 

2 

2 

4 

0.99993 

2 

3 

4 

6 

0. 83379 

2 

4 

6 

8 

0.70240 

2 

5 

8 

10 

0.60715 

2 

6 

10 

12 

0.53905 

2 

7 

12 

14 

0.49142 

2 

8. 

14 

16 

0.45945 

2 

9 

16 

18 

C.  43927 

2 

10 

18 

20 

0.42756 

2 

11 

20 

22 

0.42147 

2 

12 

22 

24 

0.41871 

2 

13 

24 

26 

0.41768 

14 

26 

28 

0.41740 

2 

15 

28 

30 

0.  41737 

2 

16 

30 

32 

0.41737 

2 

17 

32 

34 

0.41734 

2 

18 

34 

36 

0.41729 

2 

19 

36 

38 

0.41724 

2 

20 

38 

40 

0.41720 

2 

21 

40 

42 

0.41713 

2 

22 

42 

44 

0.41716 

2 

23 

44 

46 

0.41715 

2 

24 

46 

48 

0.41715 

2 

25 

48 

50 

0.41714 

2 

26 

50 

52 

0.41714 

2 

27 

52 

54 

0.41714 

2 

28 

54 

56 

0.41714 

2 

29 

56 

58 

0.41714 

2 

30 

58 

60 

0.41714 

G2(K)  T  <  K I 


0.0  0.0 

0.08332  12.00000 

0.04173  12.00000 

0.02544  12.00000 

0.01761  12.00000 

0.01346  12.00000 

0.01125  12.00000 

0.01007  12.00000 

0.00949  12.00000 

0.00924  12.00000 

0.00916  12.00000 

0.00915  12.00000 

0.00916  12.00000 

0.00917  12.00000 

0.00917  12.00000 

0.00917  12.00000 

0.00917  12.00000 

0.00917  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.0  0.0 

0.08332  12.00000 

0.04173  12.00000 

0.02544  12.00000 

0.01761  12.00000 

0.01348  12.00000 

0.01125  12.00000 

0.01007  12.00000 

0. 00949  12.00000 

0.00924  12.00000 

0.00916  12.00000 

0.00915  12.00000 

0.00916  12.00000 

0.00917  12.00000 

0.  00917  12.00000 

0.00917  12.00000 

0.00917  12.00000 

0.00917  12.00000 

0. 00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.  00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 

0.00916  12.00000 


E(K) 

GATE(K) 

-0.25723 

360.  02466 

-2.29614 

7.35863 

-2.42987 

5.49924 

1.85547 

4. 78637 

-1.64236 

4.41870 

0.28345 

4.20671 

0.51604 

4. 08039 

-0.92641 

4.00630 

0.25426 

3.96513 

-0.20528 

3.94418 

-0.49200 

3.93481 

-0.20381 

3.93134 

0.60071 

3.93040 

-0.02434 

3.93028 

-1.53360 

3.9302  8 

0.37788 

3.93019 

2.11394 

3.93004 

-1.75706 

3.92987 

-0.76671 

3.92973 

2.04466 

3.92964 

1.47659 

3.92957 

1.01303 

3.92955 

1.19057 

3.92953 

0.14793 

3.92953 

1.20099 

3.92953 

-1.30133 

3.92953 

-1.24301 

3.92953 

1.05223 

3.92953 

0.91925 

3.92953 

1.05219 

3.92953 

0.06944 

360.02466 

-1.41083 

7.35863 

-0.55978 

5.49924 

-0.06970 

4. 78637 

-1.33647 

4.41670 

0.03C41 

4.20671 

-3.23211 

4.08039 

-0.54752 

4.00630 

-1.07857 

3.96513 

-0.06239 

3.94418 

-1.32112 

3.93481 

1.27428 

3.93134 

0.31332 

3.93040 

-1.29135 

3.93028 

1.42955 

3.93028 

-0.51846 

3.93019 

-0.90848 

3.93004 

1.05110 

3.92987 

-0.73004 

3.92973 

-1.30844 

3.92964 

1.52113 

3.92957 

-0.49646 

3.92955 

-0.43472 

3. 92953 

0.09782 

3.92953 

0.06985 

3.92953 

0.27159 

3.92953 

1.84546 

3.92953 

-0.60997 

3.92953 

-1.34320 

3.92953 

77 


final  jset  data 


JSETd,  1)=  i 
JSETd,  2 )-  3 
JSETd,  3 ) =  5 
JSETd,  4  =  7 
JSET (1 |  5  =  9 
JSETd,  6)  =  11 
JSETd,  7)=  13 
JSETd,  8 ) -  15 
JSETd,  9)  =  17 
JSET(1, 10)=  19 
JSETd, 11)=  21 
JSETd, 12)=  23 
J§ETd,13)  =  25 
JSETd, 14)=  27 
JSETd, 15  =  29 
JSETtl, 16)=  31 
JSETd, 17)=  33 
JSETl 1,18)=  35 
JS  ET  d  » 19  )  =  37 
JSETd, 20)=  39 
JSET( 1,21)=  41 
JSETd, 22)  =  43 
JSETd  ,23)=  45 
JSETd,24  =  47 
JSETd, 25)=  49 
JSETd, 26)=  51 
JSETd, 27)=  53 
JSET  1,28)=  55 
JSETd, 29)=  57 

JSETd, 3  =  61 
JSETd,  1)=  2 
JSET  2,  2)=  4 
JSET  2  3 )=  6 
JSET (2,  4 ) =  8 
JSETd,  5)=  10 
JSET(2,  6 ) =  12 
JSET (2,  7) =  14 
JSETI2,  8 )=  16 
JSETC2,  9 ) =  18 
JSET(2,10)=  20 
JSET (2, 1 1 )=  22 
JSETd, 12)=  24 
JSET(2, 13)=  26 
JSET (2, 14)=  23 
JSETd, 15)=  30 
JSETd, 16)=  32 
JSETd, 17)=  34 
^||T d ,18)=  36 
JSET  2,I9)=  38 
JSETd, 20J=  40 
JSET (2, 21)=  42 
JSET(2,22)=  44 
JSET (2,23)=  46 
JS|T(2,24)=  48 
JSbT(2, 25)=  50 
JS  ET ( 2, 26 ) =  52 

JSETd,  28)=  56 
JSETd, 29)=  58 
JSET{2 ,30) =  60 


NTAR  =  1 


FILTERED  AND 

SMOOTHED 

EMITTER 

TARGET  DATA 

CORRELATED 

TO  NTAR  =  1 

NUM 

FREQ 

PRF 

PW 

THETAD 

THTD 

THTD1 

1 

1197.0 

150.0 

3.50 

105.22139 

105.22139 

105.22139 

3 

1197.0 

150.0 

3.50 

104.94077 

104.94 078 

105.22136 

5 

1197.0 

150.0 

3.50 

102.36406 

102.74568 

105.59840 

7 

1197.0 

150.0 

3.50 

98.88550 

99.60863 

106.07678 

9 

1197.0 

150.0 

3.50 

99.29208 

98.56316 

105.71794 

11 

1197.0 

150.0 

3.50 

95. 14084 

95.89789 

106.00923 

13 

1197.0 

150.0 

3.50 

94.13567 

93.99150 

105.96504 

15 

1197.0 

150.0 

3.50 

92.50012 

92.22116 

105.  89708 

17 

1197.0 

150.0 

3.50 

89.34970 

89.86916 

105.99577 

19 

1197.0 

150.0 

3.50 

88.07285 

87.92729 

105.97491 

21 

1197.0 

150.0 

3.50 

85.69966 

85.81842 

105.98711 

23 

1197.0 

150.0 

3.50 

83.28149 

83.56749 

106.00682 

25 

1197.0 

150.0 

3.50 

81.26472 

81.38341 

106.01180 

27 

1197.0 

150.0 

3.50 

79.86276 

79.51279 

106.00418 

29 

1197.0 

150.0 

3.50 

77.43318 

77.44736 

106.00429 

31 

1197.0 

150.0 

3.  50 

73. 85582 

7^. 74934 

106.00293 

33 

1197.0 

150.0 

3.50 

72.90050 

72.65031 

106.00438 

35 

1197.0 

150.0 

3.50 

72.60910 

71.37729 

106.01534 

37 

1197.0 

150.0 

3.50 

67.66759 

68.69151 

106.00587 

39 

1197.0 

150.0 

3.50 

65.77895 

66.22577 

106.00211 

41 

1197.0 

150.0 

3.50 

66.04028 

64.84860 

106.01045 

43 

1197.0 

150.0 

3.50 

64.31984 

63.45  921 

106.01512 

45 

1197.0 

150.0 

3.50 

62.62923 

62.03877 

106.01743 

47 

1197.0 

15C.C 

3.50 

61.49768 

60.80374 

106.01921 

49 

1197.0 

150.0 

3.50 

59.35091 

59.26468 

106.01933 

51 

1197.0 

150.0 

3.50 

58.88116 

58.18115 

106.01985 

53 

1197.0 

150.0 

3.50 

55.42735 

56.18584 

106.01968 

55 

1197.0 

150.0 

3.50 

53.34729 

54.07178 

106. 01976 

57 

1197.0 

150.0 

3.50 

53.39183 

52.77852 

106.01956 

59 

1197.0 

150.0 

3.50 

52. 08127 

51.54547 

106.01935 

61 

1197.0 

150.0 

3.50 

51.08221 

50.46893 

106.01910 

SMOOTHED  INITIAL  BEARING  ANGLE  =  106.01910 
FILTERED  FINAL  BEARING  ANGLE  =  50.46893 

PLANE  TRIANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  33.24187N 

EMITTER  LONGITUDE  =-117.42503W 


NTAR  =  2 


FILTERED  AND  SMOOTHED  EMITTER  TARGET  DATA  CORRELATED  TO  NTAR  =  2 


NUM 

FREQ 

PRF 

PW 

THETAD 

THTD 

THTD1 

2 

1212.0 

250.0 

3.00 

122.24252 

122.24252 

122.24252 

4 

1212.0 

250.0 

3.00 

122.29161 

122.29160 

122.24252 

6 

1212. 0 

250.0 

3.00 

120.92984 

121.16432 

122.^7420 

8 

1212.0 

250.0 

3.00 

119.94717 

120. 11375 

122.58440 

10 

1212.0 

250.0 

3.00 

119.21582 

119.24319 

122.59787 

12 

1212.0 

250.0 

3.00 

117.06377 

117.67981 

122.83490 

14 

1212.0 

250.0 

3.00 

116.65103 

116.63556 

122.83015 

16 

1212.0 

250.0 

3.00 

112.34737 

114.09503 

123.25594 

18 

1212.0 

250.0 

3.00 

112. 10175 

112.40875 

123.31427 

20 

1212.0 

250.0 

3.00 

109.82207 

110.43947 

123.40269 

22 

1212.0 

250.0 

3.00 

108.74931 

108.78540 

123.40640 

24 

1212.0 

250.0 

3.00 

105. 82967 

106.59761 

123.45934 

26 

1212.0 

250.0 

3.00 

106.09219 

105.35014 

123.42816 

28 

1212.0 

250.0 

3.00 

104.02385 

103.84129 

123.42418 

30 

1212.0 

250.0 

3.00 

100.94479 

101.69717 

123.42987 

32 

1212.0 

250.0 

3.00 

101.37944 

100.54652 

123.4311 2 

34 

1212.0 

250.0 

3.00 

9  8.43813 

98.74020 

123.42911 

36 

1212.0 

250.0 

3.00 

96.18474 

96.71411 

123.42439 

38 

1212.0 

250.0 

3.00 

96.01830 

95.40575 

123.43004 

40 

1212.0 

250.0 

3.00 

93.  04437 

93.46983 

123.42645 

42 

1212.0 

250.0 

3.00 

90.44980 

91.21239 

123.42110 

44 

1212.  0 

250.0 

3.00 

90.87807 

89.99149 

123.42590 

46 

1212.0 

250.0 

3.00 

87.80681 

88.09616 

123.42477 

48 

1212.0 

250.0 

3.00 

85.91864 

86.17201 

123.42412 

50 

1212.0 

250.0 

3.00 

84.47925 

84.42223 

123.42419 

52 

1212.0 

250.0 

3.00 

82.71225 

82.67152 

123.42422 

54 

1212.0 

250.0 

3.00 

81.17096 

81.01265 

123.42426 

56 

1212.0 

250.0 

3.00 

81.11581 

80.04016 

123.42412 

58 

1212.0 

250.0 

3.00 

77.89078 

78.24629 

123.42422 

60 

1212.0 

250.0 

3.00 

75.29662 

76.07950 

123.42451 

SMOOTHED  INITIAL  BEARING  ANGLE  =  123.42451 
FILTERED  FINAL  BEARING  ANGLE  =  76.07950 

PLANE  TRI ANGULATION  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =  32  .78056N 

EMITTER  LONGITUDE  =-U7.23346W 
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* 

*  KALMAN  FILTER  PROGRAM  TO  ESTIMATE  EMITTER  LOCATION 

*  FROM  FILTERED  BEARING  ANGLES-OF-ARRI VAL 

* 


THIS  FORTRAN  PROGRAM  IS  DESIGNED  TO  ANALYZE  AND  SORT 
ELECTRONIC  EMITTER  PARAMETERS  AND  AIRCRAFT  NAVIGATION 
DATA,  TO  FILTER  EMITTER  DATA  USING  KALMAN  FI LTER  TECH 
NIQUES  TO  MINIMIZE  BEARING  ANGLE-OF-ARR I VAL  MEASUREMENT 
NOISE,  TO  SMOOTH  INITIAL  UNFILTERED  BEARING  ANGLES, 

AND  TO  PREDICT  EMITTER  LOCATIONS  USING  TRI ANGULATI ON 
METHODS 

DIMENSION  ALT(IOO) , BRNG ( 100 ) , BRNGDf 100) ,0111100), 

1 012(100), 02 1(100), D2 2(100), E(100),FREQ(  100) ,G1(100) , 
2G2C 100) ,GATEflOO) ,HDG( 130) , HDGO( 130 ) , JSET( 30 , 50 ) , LW ( 2) 
3M0DEN( 100) ,M0DET(100) ,MW(2) ,NS1 ( 100) ,P11 ( 100) , P12 ( 100) 
4P22(100),PIN{2,2),PIM11(100),PIN121100J,PIN22( 100), 
5PITCH{ IOC) , PRF ( 1 00 ), PW ( 100 ),Q1 1(100) , Q12 ( 100 ) , Q22 ( 1 00) 
6QPll(100),0y12(  100)  •  OP  21  (  .100)  ,  OP  22  (  100)  ,  P  (  100 )  ,  Rf>  ( 1 00 ) 
7ROLL(100),SLA(100) ,SLAD( 100 ) , SLO ( 100) , SLOD l 100),T( 100) 
8TT (100),TAT(I00) ,TIMEN(100) ,TIMET(100) ,TDT(100), 
9TDTD(100),TDTD1(100),THT(100),THTD( 100) .THTl(lOO) , 
OTHTDK  100)  , TPT  ( 100)  ,  TPTD  ( 1 00  ),  THETA { 100  )  ,  THETADf  100  )  , 
1TILA(10) , TLA (10) , TLAD( 10) ,TLC( 10) , TLOD(IO) ,VEL1100) , 
2VELE ( 100) ,VELN( 100), NAVI  100) 

SUBROUTINE  TO  READ  EMITTER  TARGET  AND  AIRCRAFT 
NAVIGATION  DATA  FROM  CARD  DATA  DECK 
DATA  SEQUENCE  MUST  BE  OF  FORMAT  TGT/NAV 

NUM=65 

DO  1  1=1, NUM 

TYPE=1 1. 0  EMITTER  TARGET  DATA 

READ(5,51)TGT,TIMET( I) ,8RNG( I),PRF{ I ),MODET( I J,PW( I ) , 
1FREQU  i 

TYPE=7.0  AIRCRAFT  NAVIGATION  DATA 

READ (5,52)  NAV , T IMEN ( I ),MODEN( I ) , ALT{ I ) , SLA( I ) , SLO( I ) 
READ(5,56)hDG( I) ,VELFl I) ,VELN( I ) ,ROLL( T) , PITCH ( I ) 

SUBROUTINE  TO  COMPUTE  AIRCRAFT  VELOCITY 

VELS=VELE(I)**2+VEl:  (I )**2 
7EL( I ) =SQRT ( VELS ) 

1  CONTINUE 

SUBROUTINE  TO  CHANGE  ANGLES  AND  LATITUDE/LONGITUDE 
FROM  RADIANS  TO  DEGREES  +  TENTHS  OF  DEGREES 

WRITE( 6, 57  ? 

DO  5  J=1,NUM 
PIRAD=57. 29578 
HDGD( J  )=HDG( J ) "PIRAD 
BRNGD( J)=3RNG( J) *P . RAD 
SLAD(J)=SLA( J)*PIRAD 
SL0D(J)=SL0(J)*PIRA9 
THE7AI J) =SRNG ( J ) +HDG( J ) 

IF(THETA( JJ.GT. 6. 233186)  THETA ( J )=THETA( J ) -6 .2831 86 
THE! AD( J ) =BRNGD( J ) +HDGD( J ) 

IF ( THETADt  J) ,G  > .360.0)  THET AD( J ) =THETAD( J )-360.0 
WRITE ( 6, 58 ) J ,HUGD( J ) , SLAD( J ) , SLGD(  J ) ,6RNGD ( J ) , 

1THET  AD ( J ) , THET  A( J ) 

5  CONTINUE 
C 
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C 

c 

c 


PROGRAM  TO  SORT  EMITTER  TARGET  DATA  AND  ESTIMATE  NUMBER 
OF  DISTINCT  EMITTER  TARGETS 

DATA  IS  INITIALLY  SORTED  BY  FREQUENCY  AND  PRF 
NTAR=0 

DO  10  1  =  1  *  NUM 
IF(I.EQ.l)  GO  TO  19 
L=I-1 

DO  18  KQ=1 » L 
M=I-KQ 

DELTF=FREQ( I J-FREQ (M) 

DELTPR=PRF(I )-PRF(M) 

IF ( ABS ( DELTF) .  LE .4«0*AND«ABS(DELTPR) .LE.4. 0)  GO  TO  10 
CHECK  FOR  MULTIPLES  OF  PRF 


IF ( ABS { DELTF }«GT .4.0)  GO  TO  18 
DO  11  N=2,5 
RK=N*PRF (M ) 

SK=PRF ( I ) 

TK=PRF ( M) /FLOAT! N) 

CK=ABS I RK-SK ) 

DK=ABS (TK-SK) 

FK=N*4. 0 

TF(CK.LT.FK.OR.DK.LT.FK)  GO  TO  10 

CONTINUE 

CONTINUE 

NTAR=NTAR+1 

WRITE ( 6  *  59) NTAR 

WRITE(6,61)NTAR 

NJ=1 


JS£T(NTAR,NJ)=I 
DO  13  J  =  1 » NUM 
IF(J.EQ.I)  GO  TO  13 
DELF=FREQ(J)-FREQ< I) 
DELPRF=PRF(J)-PRF(1) 


IF{ABS(DELF)«LE.4.0)  GO  TO  4 


GO  TO  13 


CHECK  FOR  SUBSEQUENT  MULTIPLES  OF  PRF 


4  DO  12  N=l,5 
RK=N*PRF { J ) 

SK=PRF ( I ) 

TK=PRF ( J ) /FLOAT ( N) 

CK=ABS( RK-SK) 

DK=ABS ( TK-SK) 

FK=N*4.0 

IF(CK.LT.FK.OR.DK.LT.FK)  GO  TO  14 

12  CONTINUE 
GO  TO  13 

14  NJ=NJ+1 

JSET(NTAR,NJ)=J 

13  CONTINUE 
NST <  NT  AR)=NJ 
NSTA=NST (NTAR) 

IF(NSTA.EQ.l.O)  GO  TO  17 


SUBROUTINE  TO  CHECK  FOR  AND  ELIMINATE  360  DEGREE 
VARIATION  IN  EMITTER.  BEARING  ANGLE  THETA 


DO  9  J=2,NSTA 
JM=J-1 

KK=J SET ( NTAR »JM) 

K=JSET (NTAR, J ) 

IF  ( THETADI  KK  >  .  LT  .1 0. 0.  AND.THET  AD  (K. )  .GT  .350 .0  )  GO  TO  15 
IFITHETADtKKJ.GT. 350.0. AND. THETADI K) .LT. 10.0)  GO  TO  16 
GO  TO  9 
15  DO  6  MM-ltJM 

M=J SET (NTAR* MM) 

THETAD(M)=THFTAD(M) +360.0 
THETA! M)=THETA(M)+6. 283136 
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C 

C 

C 

C 


6 

16 

7 

9 

17 


C 

C 

C 


8 

10 


CONTINUE 
GO  TO  17 
DO  7  MN=J*NSTA 
M=JSET (NTAR»MN) 

THETAD(M)=THET  ADIM 1+360.0 

THETAIM)=THETA(M)+6.283186 

CONTINUE 

GO  TO  17 

CONTINUE 

PRINT  UNFILTERED  BEARING  LINES  OF  SIMILAR 
FREQUENCY  AND  PRF 

DO  8  J=1 »NST A 
K=JSET (NTARt J) 

WRITE! 6»601K» FREQ! Kl tPRF!K) »PW(K) »HDGD(K1 
1THETADIK) 

CONTINUE 

CONTINUE 


BRNGD(K) 


C 

C 

c 

c 

c 

c 

c 


25 


C 

C 

C 


SUBROUTINE  TO  COMPUTE  INITIAL  EMITTER  TARGET  JSET  DATA 

WRITE (6  »62 ) 

DO  25  1=1 tNTAR 
NSTA=NST ( I ) 

WRITE  (6.631 (I»Jt JSET{  I , J 1 , J=l, NSTA J 
CONTINUE 

PROGRAM  TO  FILTER  NOISY  MEASURED  BEARING  ANGLE  THETAD(K) 
AND  AIRCRAFT  NAVIGATION  DATA  FOR  EACH  SUSPECTED  EMITTER 
TARGET  OF  SIMILAR  FREQUENCY  AND  PRF 

INITIALIZATION  OF  KALMA'N  FILTER  EQUATION  PARAMETERS 

WRITE (6  » 50 ) 

DO  20  I =1 i NTAR 
KI=JSET{ I»  11 
Pll { KI ) =10000.0 
P12! K I ) =  0.  0 
P22 ( K I  1  =  10000.0 
Q11IKI 1=0.0 
Q12IKI 1=0.0 
Q22 ( KI 1=0.0 
D1H  KI  1=1.0 
D12IKI 1=0.0 
D2 1 ( K 1 1=0.0 
D22(KI 1=1.0 
R( K I  1  =  144.0 

G1(KI1=P11(KI)/(P11(KI1+R(KI)1 
G2(KI)=P12(KI1/(P11(KI)+RCKI)1 
THTD (KI)=THETAD(KI 1 
THTD1(KI)=THETAD(KI) 

TDTD !KI)=VEL(KI)”$IN(BRNG(KI)1 +P I RAD/6 00 000 .0 
TOTDKKI  1=TDTD(KI ) 

TIKI  1=0.0 
K2=0 
K3=  1 

WRITE(6,64)I,K3,K2fKItGl{KI},G2{KI ),T(KI) 

START  OF  KALMAN  FILTER  PREDICTION  PROBLEM 

NSTA=NST { I J 
DO  21  J=2,NSTA 
22  K=JSET ( I » J  1 

KK=JSET(ItJ-1) 

TKM1=TIMET IKK) 

TIKI =T I  MET IK1-TKM1 
TT(K1=TIK)/1000.0 
Qll(K)=TT(Kl**4/4.0 
Ql2(K)=TT(KK*3/2.0 
Q22! K 1 =TT! K) **2 
R(K 1=144.0 
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START 


KALMAN  FILTER  RECURSION  EQUATIONS 


P11(K)=P11(KK)*( l.O-Gl(KK) )+2.0*P12(KK)*T(K)-(P12(KKi* 
1G1(KK)+P11(KK)*G2(KK) )*T(K)+(P22(KK)-P12(KK)*G2(KK)  )* 
2T(K)**2+Q11(K) 

P12(K)=P12(KK)*(1.0-G1(KK) )+(P22(KK)-P12(KK)*G2(KK) )* 
1T( K) +Q12 ( K ) 

P22tK)=P22(KK)-P12(KK)*G2{KK)+Q22(K) 

G1(K)=P11(K)/(P11(K)+R(K)) 

G2(K)=Pi2(K)/(Pll(K)+R(K)) 

TPTD(K)=THTD(KK)+TDTD(KK)*T(K) 

E(K)=THETAD(K)-TPTD(K) 

THTD(K)=TPT0(K)+G1(K)*E(K) 

TDTD(K)=TDTD(KK)+G2(K)*E(K) 

SMOOTHING  EQUATIONS  FOR  FIRST  BEARING  LINE  ESTIMATE 

PIN( 1 t 1)=P11 (K) 

PIN( 1«2)=P12(K) 

PINI2, 1)=P12(K) 

PI N( 2 ,2) =P22 IK) 

CALL  MINV(PIN*2»DET,LW*MW) 

PIN1 1 <  K ) =P IN  f 1 , 1 ) 

PI  N12  <  K)  =PIfJ(  1 ,2 ) 

PIN22(K)=PIN(2,2) 

QPU(K)=Q11(K)*PIN11(K)+Q12(K)*PIN12(K) 

QP12 ( K ) =Q1 1 ( K) *  PIN12 ( K ) +Qi2 ( K ) *P IN22 (K ) 

QP21(K)  =  Q12(K)*PINli(K)-fQ22(KK-PIN12(K) 
QP22(K)=Q12(K}*PIN12(K}+Q22(K)*PIN22(K) 

DIKK)  =D  1 1  ( KK]  *  (  1.  0-0PI1IK)  )-D12(KK)*QP21(K)+Dll(KK)* 
1QP21 (K )*T(K) 

D12IKJ  =012 ( KK ) *{ 1 .0-QP22 (K ) J-Dll (KK ) *QP 12( K )vDll (KK ) * 
1(QP22(K)-1.0)*T(K) 

D21 ( K J  =021 ( KK ) *( 1*  0-QP 11 (K ) )-D22(KK) *QP21( K) +D21 ( KK) * 
1QP21 (  K) *T ( K) 

D22(K)=D22(KK)*< 1. 0-QP22 (K) )-D21 (KK) *QP12 ( K )+D21 ( KK) * 

1 (QP22 (K)-1.0)*T(K) 

TH  ;'D1(K)=THTLU  (KK)-MDIl  (K)*G1  (  K  )+D12  (K  )  *G2  (K  )  )*E(K) 
TDTDI ( K) =TDTDI ( KK ) + ( D2 1 ( K) *G1 ( K ) +D22 ( K ) *G2 ( K ) ) *E ( K ) 

CORRELATION  GATING  SCHEME  TO  ESTIMATE  WHETHER  FILTERED 
BEARING  ANGLE  THTD(K)  IS  AN  EMISSION  FROM  EMITTER  TARGET 
NT AR  =  I  OR  A  SPURIOUS  EMISSION 

GATE (K)=SQRT(PI1(K)+F (K) )/2.0 

WRITE (6, 65) I ,J,KK,K,G1(K),G2(K),T(K) , E< K ) , GATE ( K ) 
IF(ABS(E(K)).LT.GATE(K))  GO  TO  21 

THTD(K)  IS  A  SPURIOUS  BEARING  LINE  AND  IS  DISCARDED 

NST ( I ) =NST ( I )-l 
NSTA=NST ( I ) 

IF(NSTA.LT.J)  GO  TO  20 
DO  27  L=J,NSTA 
JSET(I,L)=JSET(I,L+1) 

CONTINUE 
GO  TO  22 
CONTINUE 

FILTERED  BEARING  ANGLE  THTD(K)  IS  CORRELATED  TO  EMITTER 
TARGET  NT  AR  =  I 

CONTINUE 

SUBROUTINE  TO  COMPUTE  FINAL  EMITTER  TARGET  JSET  DATA 

WRIT  E ( 6, 66 ) 

DO  3  0  I =1 » NT  AR 
NSTA=N  ST ( I ) 

WRITE ( 6,63 )( I,J, JSET( I,J), J=1,NSTA) 

CONTINUE 
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35 

C 

50 


51 


52 


53 


54 

55 


56 


57 


58 

59 

60 
61 


62 

63 

64 

65 

66 


67 


68 

70 


PROGRAM  TO  COMPUTE  TARGET  POSITION  BASED  ON  A  PLANE 
TRIANGULATION  SOLUTION- 


DO  35  I =1 ,NTAR 
WRITE! 6, 59 ) I 
WRITE!6,67)I 
NSTA=NST ( I } 

KI=J  SET( 1,1) 

KF=JSET(I,NSTA) 

DO  45  J=1 ,NSTA 
K=JSET  ( I ,  J  ) 

WRITE(6.60)K,FREQ!K),PRF*K)  »PW  ( K  )"»THETAD{'K  i  ,THTD(K)  , 
1THTDKK) 

CONTINUE 

THT(KF)=THTD(KF)/PIRAD 

THTl(KF) =THTD1 ( KF) /PI  RAD 

TAT ( I ) =TAN (THT 1 l KF ) ) -TAN ITHT! KF ) ) 

WAV(I)=($LA(KI)+SLA(KF))/2.0 

TILA( I )=( ( SLO(KF}-SLC(KI) ) *COS ( WAV! I ) ) +SLA (KI )* 
lTAN!THTl(KF))-SLA(KF):i:TAN!THT(KF))  J/TAT!  I) 

TLA! I } =( !SLO!KF)-SLO(KI) )*COS(TILA( I)M-SLA(KI)* 
lTANCTHTl(KF) }-SLA( KF ;*TAN( THT! KF)) )/TAT(I) 

TLAD ! I )=TLA! I ) *P IRAQ 

TLO(I)=SLO!KF)+(TLA(I)-SLA(KF) )*TAN(THT(KF) )/ 
ICOStTILA! I) ) 

TLOD! I )=TLO{ I )*PIRAD 
WRITE!6,68)THTD1 (KF) ,THTD!KF) 

WRITE ( 6, 7U)  TLAD ( I ) , TLOD ( I ) 

CONTINUE 


FORMAT! 'l',I4X, 'LISTING  OF  KALMAN  FILTER  PARAMETERS' » 
1//,'  1  J  KK  K  Gi(K)  G2( K)  T(K)  », 

2 1 E ! K ) «  ,6X, 'GATE ( K) ' , /) 

FORMAT (7F11.5) 

FORMAT !6P13*5) 

FORMAT* *1« ,36X,' LISTING  OF  EMITTER  TARGET  DATA  AND 
1 'AIRCRAFT  NAVIGATION  DATA «,///, 1 3X ,* TARGET  PARAMETERS' 
2 ,37X, • AIRCRAFT  PARAMETERS',//,'  TYPE  TIME',4X, 

3'FREG  BRNG  PRF  PW  MO  /  TIME  HDG  ALT', 

46X , ' LAT  LONG  N.VEL  E.VEL  ROLL  PITCH' 

5,2X,'M0'  ,//) 

FORMAT!  •  TGT»,I3,lX,F9.3,lX,F6.1rlX,F7.5,LX,F6.1,lX, 
1F4.2 , IX, 1 1  ) 

FORMAT  (•  NAV* ,43X,  F9.3 , IX, F7.5 , IX, F7 .1 , IX , F8 .5,  IX, F8. 5 
11X,F8.3,1X,F8.3,1X,F8.5,1X,F8.5,1X,F3.0,/) 

FORMAT (5F13.5 ) 

FORMAT! 'I  LISTING  OF  BEARING  ANGLES-OF-ARR IVAL  AMD  ', 

1 'AIRCRAFT  NAVIGATION  DATA',///,*  N  HCGD(N)  ', 

2*SLA0(N)  SLOO(N)  BRNGD(M)  THETAD(N)  THETA(N) • ,//) 
FORMAT! •  ' ,I3,4F11.5,F10.5,F9.5) 

FORMAT  I  • 1 »  ,28X, 'NTAR  =*, 13,//) 

FORMAT  PC'  ,  1 3,2FS,  1 ,  F7. 2 ,3F12 . 5  ) 

FORMAT* '0  UNFIlTcRED  EMITTER  TARGET  DATA  INITIALLY  ', 

1  *  ASSOC  I  AT  ED  TO  NTAR  =',I3,//,'  EMITTER  BEARING  LINES', 
2'  OF  SIMILAR  FREQUENCY  AND  PRF  OR  PRF  MULTIPLE',////, 
3'  NUM  FREQ  PRF  PW  HDGD  BRNGD' , 

4'  7HETA0',/) 

FORMAT* »1  INITIAL  JSET  DATA',//) 

FORMAT!'  JSET! ',11,' , • , 12, ' )=' ,1 3) 

FORMAT { ' O' ,4I3,4F10«5) 

FORMAT ! •  • ,4I3,4F10.5,F12.5) 

FORMAT!  »1  FIN/'.  JSET  DATA',//) 

FOKMATCOFILTEkED  AND  SMOOTHED  EMITTER  TARGET  DATA  ', 

1 'CORRELATED  TO  NTAR  =',I2,///,'  NUM  FREQ  PRF', 

2*  PW  THFTAD  THTD  THTD 1  * , / ) 

FORMAT {• O' ,//,'  SMOOTHED  INITIAL  BEARING  ANGLE  =*, 
1F10.5,//,'  FILTERED  FINAL  BEARING  ANGLE  =• ,F10.5//) 
FORMAT  CO  PLANE  TR  I ANGULAT  ION  SOLUTION  OF  EMITTER  ', 

1  *  LOCAT  ION*  ,//,'.  EMITTER  LATITUDE  =»,F10.5,'N' 

2//,'  EMITTER  LONGITUDE  = • ,F10. 5, • W* ) 

STOP 

END 
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q  *  aft 

C  *  MONTE  CARLO  SIMULATION  RUN  OF  KALMAN  FILTER  PROGRAM  * 
C  *  * 

c 

C  THIS  FORTRAN  PROGRAM  IS  DESIGNED  TO  ANALYZE  AND  SORT 
C  ELECTRONIC  EMITTER  PARAMETERS  AND  AIRCRAFT  NAVIGATION 
C  DATa»  TO  FILTER  EMITTER  DATA  USING  KALMAN  FILTER  TECH- 
C  NIQUES  TO  MINIMIZE  BEARING  ANGLE-OF-ARR I VAL  MEASUREMENT 

C  NOISE,  TO  SMOOTH  INITIAL  UNFILTERED  BEARING  ANGLES, 

C  AND  TO  PREDICT  EMITTER  LOCATIONS  USING  TRI ANGULATI ON 
C  METHODS 
C 

DIMENSION  ALT(IOO) ,BRNG( 100) ,3RNGD{ 100) ,011(100) , 
1012(100) ,021(100 ),D22( 100) ,6(100 ),FREQ< 100) ,G1( 100) , 
2G2( 100) , GATE (100) , HOG (100) , HDGO( 100 ) , JS ET ( 5 , 40 ) , LW ( 2) , 
3 MODEM ( 100) ,MODET{ LOO) ,MW(2) ,NST(100) ,P11(1C0) ,P12(100) 
4P22(100) , PIN (2,2), Plfl 1(100), PIN12( 100), PIN22{ 100), 
5PITCH( 100) ,PRF(100) ,PW(i 00) ,Q1 1(100) , Q12 ( 100 ) , Q22 ( 100) 
6QP 11(100), QP12( 1 QO ) , QP  21 ( 100) ,0P22( 100) ,R( ICO) , RB ( 100) 
7R0LL (100), SLA (100) »SLAD( 100 ) ,SLO ( 100 ), SLOD ( 100) , T{ 100) 
8TT(100) ,TAT(100) ,TIMEN(100) ,TIMET(IOO) rTDT(100), 

9T0TD( 100 ) ,TDT01 ( 100 ) , THT ( 1 00) , THTO ( 100) , THTl { 100) , 
OTHTDK  100)  ,TPT(100)  ,TPTD{  100),  THETA  (  100),  THETAD(  100)  , 
1TILA { 5 ) » TLA( 5) » TLADi 5) ,TLO ( 5) , TLOD ( 5 ) , VEL ( 100 ) , 
2VELE(100),VELN(100),WAV( 100) 

SUBROUTINE  TO  READ  EMITTER  TARGET  AND  AIRCRAFT 
NAVIGATION  DATA  FROM  CARD  DATA  DECK 
DATA  SEQUENCE  MUST  BE  OF  FORMAT  TGT/NAV 

NUM=61 
I X=1257 
STDEV=1.0 
AVE=0.0 
WRI  TE  ( 6 ,48 ) 

DO  1  I =1 ,NUM 

READ  EMITTER  TARGET  OATA 

READ  (5,51)  TGT  ,T  I  MET  {  1 ) ,  3PNGDU) ,  PRFC  I )  ,PW  (  I )  ,FREQ  ( I) 
READ  AIRCRAFT  NAVIGATION  DATA 

READ ( 5,5 1)HDGD{ I ),SLAD( I), SLOD (I ),ALT( I) ,VELN( I ), 

1VELE ( I ) 

GENERATE  RANDOM  NOISE  TO  ADD  TO  KNOWN  EMITTER  BEARING 
ANGLES  OF  ARRIVAL 

CALL  GAUSS (IX,STDEV,AVE,V) 

THETADt I )=BRNGD( I ) +V 

2  WRITE(6»49)1,T1MET{ I },FR5Q( I)»PRF(I),PW(I) , BRNGD( I ) , 

1V,THETAD(I),HDGD(I ),SLAD(I ) , SLOD ( I ) , ALT ( I),VELN(I), 
2VELE ( I ) 

SUBROUTINE  TO  COMPUTE  AIRCRAFT  VELOCITY 

VELS=VELE(I)**2+VELN(I )**2 
VEL(I)=SQRT(VELS) 

1  CONI  I NUE 

SUBROUTINE  TO  CHANGE  ANGLES  FROM  DEGREES  TO  RADIANS 

WR ITE { 6 , 57) 

DO  5  J=1 , MUM 
PIRA0=57. 29573 
HDG(J)=HDGU(J)/PIRAD 
BRNG(  J  )  =tjRNGD(  J  )/P  IRAD 
SLA(J)=SLAD( JJ/PIRAD 
SLG( J ) =SLGD( J ) /P I  RAD 
THETA( J)=THETAD(J)/PIRAD 
RB(J)=BRNG( J)-HDG( J) 

IF( THETA (J).GT. 6.283186)  THETA ( J )=THETA { J) -6. 2831 86 
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IFtTHETAD(J) .GT. 360.0)  THETADC  J  )=THETAD<  J  )-360..0 
WRITE(6,58)J,HDGD(  J)  ,SLAD( J)  ,SL0D(  J)  rBRNGDUlr 
ITHETADt J ) »THtTAl J) 

5  CONTINUE 

PROGRAM  TO  SORT  EMITTER  TARGET  DATA  AND  ESTIMATE  NUMBER 
OF  DISTINCT  EMITTER  TARGETS 

DATA  IS  INITIALLY  SORTED  BY  FREQUENCY  AND  PRF 
NTAR=0 

DO  10  I=1»NUM 
IF(I.EQ.l)  GO  TO  19 
L  =  I-1 

DO  18  KQ=1,L 
M=I— KQ 

DELTF=FREQ(  I  HFREQ  (M ) 

DELTPR=PRF ( I )-PRF (M) 

IF(ABS(DELTF).L£.4.  0.  AND.  ABS(DELTPR)  .LE.4.0)  GO  TO  1!0 

CHECK  FOR  MULTIPLES  OF  PRF 

1F{ABS(DELTF).GT.4.0)  GO  TO  18 
DO  11  N=2,5 
RK=N*PRF (M) 

SK=PRF { I ) 

TK=PRF (M) /FLOAT (N) 

CK=AB$ ( RK— SK ) 

DK=AB$ (TK—SK ) 

FK=N*4. 0 

IFICK.LT .FK.OR.DK. LT. FK)  GO  TO  10 
1  CONTINUE 

18  CONTINUE 

19  NTAR=NTAR+1 
WRITE ( 6 » 59 ) NTAR 
WRITE{6,61)NTAR 
NJ  =  1 

JSET { NTAR*  NJ )= I 
DO  13  J  =  1  ?  NU M 
IF(J.EQ.I)  GO  TO  13 
DELF=FRFQ(J)-FRSQ(i) 

DELPRF=PkF{J)— PRF{ I) 

IFiABS(OELF)  .LE.4.0)  GO  TO  4 
GO  TO  13 

CHECK  FOR  SUBSEQUENT  MULTIPLES  OF  PRF 

4  DO  12  N=1 1 5 
RK=N*PRF ( J ) 

SK=PRF ( I ) 

TK=PRF ( J ) /FLOAT ( N) 

CK=ABS<RK-SK) 

DK=ABS (TK-SK) 

FK=N*4.0 

IFICK.LT. FK.OR.DK. LT.FK)  GO  TO  14 

12  CONTINUE 
GO  TO  13 

14  NJ=NJ+ 1 

JSET (NTAR»NJ)=J 

13  CONTINUE 
NST(NTAR)=NJ 
NSTA=NST (NTAR) 

IF(NSTA.EQ.l.O)  GO  TO  17 

SUBROUTINE  TO  CHECK  FOR  AND  ELIMINATE  360  DEGREE 
VARIATION  IN  EMITTER  BEARING  ANGLE  THETA 

DO  9  J=2»NSTA 
JM=J-1 

KK= J  SE  T ( NTAR » JM ) 

K=JSETiNlAR, J ) 

TC  /  TUCT  A  r\  /  i/i/  i  l  T  t  a  a  diiirs  T- »  •  r--r  »  r\  «  ■/  t  at  a  r  a  a  i  aa  ta  «  r 

«  *  t  «  ■  IW  •  AV  (  IVN  /  •  U  f  •  i  W  •  V  •  MMU  •  1  II'.  »  A  I  IN  I  t  O  1  •  +J  ^  \J  0  \J  $  O  U  1  U  X 

IF(THETAD(KK).GT. 350.0. AND. THETADt K) .LT. 10.0)  GO  TO  16 
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GO  TO  9 
DO  6  MM=1 i JM 
M=JSET (NTARiMM) 

THETADIM )=THETAD(M) +360.0 
THETA { M)=THETA(M)+6 .283186 

6  •  CONTINUE 

GO  TO  17 

16  DO  7  MN=J»NSTA 
M=JSET ( NTARt MN) 

THETAD(M)=THETAD(M )+360. 0 
THETAtM)=THETAIM> +6. 283186 

7  CONTINUE 
GO  TO  17 

9  CONTINUE 

PRINT  UNFILTERED  BEARING  LINES  OF  SIMILAR 
FREQUENCY  AND  PRF 

17  DO  8  J  =  1 »NSTA 
K=J$ET ( NTAR» J) 

WRITE16,60)K,FREQ{K) ,PRF<K) ,PW(K) ,HDGD(K) ,BRNGD(K) , 
lTHETAD(K) 

8  CONTINUE 
10  CONTINUE 

SUBROUTINE  TO  COMPUTE  INITIAL  EMITTER  TARGET  JSET  DATA 

WRITE(6f 62) 

DO  25  1  =  1 » NTAR 
NSTA=NST { I ) 

WRITE(6,63HI,J,JSETC  I,  J) , J  =  1,NSTA) 

25  CONTINUE 

SUBROUTINE  TO  CHECK  MONTE  CARLO  SIMULATION  ACCURACY  IN 
THE  ABSENCE  OF  RANDOM  NOISE  CONTAMINATION  OF  EMITTER 
BEARING  ANGLES 

IF(V.EQ.O.O)  GO  TO  23 
GO  TO  24 

23  WRITE ( 6 j  46 ) 

DO  26  1  =  1 » NT AR 
NSTA=NST ( I ) 

KI=JSET ( I» 1) 

KF=JSET(I,NSTA) 

THTD1( Kr) =8RNGD( KI ) 

THTD(KF)=BRNGD(KF) 

26  CONTINUE 
GO  TO  29 

PROGRAM  TO  FILTER  NOISY  MEASURED  BEARING  ANGLE  THETAD(K) 
AND  AIRCRAFT  NAVIGATION  DATA  FOR  EACH  SUSPECTED  EMITTER 
TARGET  OF  SIMILAR  FREQUENCY  AND  PRF 

INITIALIZATION  OF  KALMAN  FILTER  EQUATION  PARAMETERS 

24  WRITEI6,50) 

DO  20  I=ltNTAR 
KI=J  S£T{ I » 1 ) 

P1KKI  )  =  100.0 
P12IKI )=0.0 
P22IKI  )  =  100.0 
Q11IKI )=0.0 
Q12IKI )=0.0 
Q22IKI )=0.0 
DllCKI )=1.0 
D12IKI )=0.0 
D2KKI  )  =  0.0 
D22IKI )=1.0 
R(KI  )  =  1.0 

G1(KI)=P11(KI)/(P11CKI)+R(K!)) 

G2( K I ) =P12 (KI )/(Pll(KI)+R(KI)) 

TUTH/i/  T  * 
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THTD1 ( KI )=THETAD(KI ) 

TDTD(KI )=VEL(KI )*SIN(RBCKI ))/500Q0Q.0 
TDTDHKI  )=TDTD{KI) 

T(KI )  =  0.0 
K2=0 
K3=  1 

WRITE(6,64)I,K3,K2,KI,G1(KIJ ,G2CKI),T(Kt) 

START  OF  KALMAN  FILTER  PREDICTION  PROBLEM 

NSTA=NST { I ) 

DO  21  J=2» NSTA 
K=JS  ET  ( I » J  ) 

KK=JSET( I , J-l) 

TKM1=T IMET (KK) 

T(K)=TIMET(K)-TKM1 

TT(K)=T(K)/1000.0 

Qll(K)=TT(K)**4/4.0 

Q12(K)=TT(K)**3/2.0 

Q22(K)=TT(K)**2 

R(K)=1.0 

START  OF  KALMAN  FILTER  RECURSION  EQUATIONS 

Pll (K)=P11(KK)*(1.0-G1(KK) )+2.0*P12(KK)*T(K)-(P12(KK)* 
lGl(KK)+Pll(KK)*G2(KK))*T(K)+(P22(KK)-Pi2(KK)*G2(KK) )* 
2T(K)**2+Q11(K) 

P12(K) -P12 ( KK) *( 1 «0—Gl (KK) )+(P22(KK)-P12(KK) *G2( KK ) ) * 
1T(  K )  +Q  12(  K ) 

P22(K)=P22(KK)-P12(KK)*G2(KK)+Q22(  K) 
G1(K)=P11(K)/(P11(K)+R(K)) 

G2(K)  =  P12(K)/(P11(K)+P.(K)) 
TPTO(K)=THTD(KK)+TOTD(KK)*T(K) 

E(K)=THETAD(K)-TPTD(K) 

THTD(K)=TPTD(K)+G1(K)*E(K) 

TDTD ( K ) =TDTD( KK )+G2 ( K )*E( K ) 

SMOOTHING  EQUATIONS  FOR  FIRST  BEARING  LINE  ESTIMATE 


PIN(1, 
PIN( 1, 
P I N  ( 2 1 
PIN(2, 
CALL  M 
PIN11( 
PI N12 ( 
PIN22( 
QP1KK 
QP12IK 
QP21 (K 
QP22  ( K 
Dll(K) 
1QP2KK 
D12 ( K) 
1(QP22( 
D21(K) 
1QP21 ( K 
D22( K ) 
1 (QP22 ( 
THTDK 
TDTD1 ( 


1 )  =P11  ( K 

2)  =P 12( K 

1 )  =P 12 ( K 

2 )  =P22  ( K 
INVIPIN, 
K) =P  IN  ( 1 
K)=PI.\'(i 
K )=PIN( 2 
)=Q1 1 ( K) 
)  =  Q 1 1 « K ) 
)=Q12( K ) 
)=Q12(K) 
=D 1 1 ( KK) 
)*T(K) 
=D12 ( KK ) 
K)-1.0)* 
=D21 (KK ) 
)*T(K) 
=D22(KK) 
K)— 1  .0  )* 
K)  =THTD1 
K) =TDTD1 


2,DET,LW,MW) 

»1) 

*2) 
t  2 ) 

*P IN  11 (K  )+912 
*PIN12(K)+G12 
-PIN11(K)+Q22 
*PIN12(K  )+Q22 
*( l.O-QPll(K) 

*( 1.0-QP22IK) 
TC  K> 

*( 1.0-QP11CK) 

*( 1.0-QP22IK) 
T(K) 

IKK) +  (011  (K)* 
(KK)+(D21(K)» 


(K)*PIN12(K) 

( K ) *P IN22 (K) 

(K)*PIN12(K) 

{ K) *P IN22 (K  ) 

)-D12(KK)*QP21(K)+Dll(KK)* 

)-Dll(KK)*QP12(K?+Dll(KK)* 

)-D22(KK)*QP21( K)+D21(KK)* 

)-D21 (KK ) *QP12  (  K )  +02 II  KK) 

G1(K)+D12(K)*G2(K  )  )*E(K) 
G1(K)+D22(K)*G2(K))*E(K) 


CORRELATION  GATING  SCHEME  TO  ESTIMATE  WHETHER  FILTERED 
BEARING  ANGLE  THTD(K)  IS  AN  EMISSION  FROM  EMITTER  TARGET 
NT AR  =  I  OR  A  SPURIOUS  EMISSION 

GATE (K)=3.0*SQRT (Pll (K)+R(K) ) 

WRITE(6t65)I,J*KK,K,Gl(K)tG2(K),T(K)»E(K),GATE(K) 
IF(A3S(E(K) ) .LT.GATE(K) )  GO  TO  21 


THTDl K ) 


SPURIOUS  RFARTNR 


nr  sr  arofo 
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NST ( I ) =NST( I )-l 
NSTA=NST { I ) 

IF(NSTA.LT.J)  GO  TO  20 
DO  27  L=J » NSTA 
JSET(I,L)=JSET(I,L+1) 
CONTINUE 
GO  TO  22 

CONTINUE 

FILTERED  BEARING  ANGLE  THTD(K) 
TARGET  NTAR  =  I 


IS  CORRELATED  TO  EMITTER 


20  CONTINUE 

SUBROUTINE  TO  COMPUTE  FINAL  EMITTER  TARGET  JSET  DATA 

WRITE ( 6, 66 ) 

DO  30  1=1, NTAR 
N$TA=NST ( I ) 

WRITE! 6,63 )( I, J, JSETI I, J) ,J=1,NSTA) 

30  CONTINUE 

PROGRAM  TO  COMPUTE  TARGET  POSITION  BASED  ON  A  PLANE 

TRlANGULATI GN  SOLUTION 

29  DO  35  1=1, NTAR 
WRITE(6,59)T 
WRITE ( 6 ,67) I 
NSTA=NST ( I ) 

KI =JSETC 1,11 
KF=JSET(I,NSTA) 

DO  34  J=1 , NSTA 
K=JSET ( I , J ) 

WRITE(6,fcO)K,FREQ(  K)  ,PRF(K)  , PW( K)  ,THETAD t K  )  ,THTD( K ) , 
1THTD11K) 

34  CONTINUE 

THT ( KF ) =THTD ( KF)  /PI  RAD 

THT1 ( KF ) =THTD1 (KF)/PIRAD 

TATI  I ) =TAN{THT 1 { KF) ) -TAN (THT (KF ) ) 

WAV (I )=(SLA(Ki )  +  SLA ( KF ) J/2.0 

T I L  A ( I )  =  < (SLC(KF)-SLO(KI )) -COS  O'AVC  I  ))  +SLA ( K  I) * 
lTAN(THTHKF)  )-SLA(KF)*TANITHT(KF)}  )/TAT(  I) 

TLA(I)=( (SLO(Kr)-SLO(KI) )*CCS(TILA(I ) ) +SLA(KI )* 
1TANCTHT1 (KF) }-SL A ( KF ) *TAN ( THT ( KF ) )  )/TAT{  I) 

TLAD ( I  )  =  TLA( I ) *PI RAD 

TLO( I )=SL0(KF)+(TLA( I)-SLA(KF) )*TAN(THT(KF) )/ 

1C0SI TILA(I ) ) 

TLOD( I )=TLO( I ) *PIRAD 
WRITE(6,68)THTD1(KF),THTD(KF) 

WR I T E ( 6 , 7 0 )  TLAD(I ) ,TLOD(I ) 

"35  CONTINUE 

"46  FORMAT (  *  0  THIS  MONTE  CARLO  SIMULATION  HAS  NO  EMITTERS 
1*  BEARING  ANGLE  MEASUREMENT  NOISES//,'  EXECUTE  A  ', 
2'CAL IBRATIGN  CHECK  FOR  SIMULATION  ACCURACY  IN  ABSENCE' 
3'  OF  RANDOM  NOISE') 

48  FORMAT  (' 1S36X, 'LISTING  OF  EMITTER  TARGET  DATA  AND  ', 

1  *  AIRCRAFT  NAVIGATION  DAT  A* ,///, 13X ,* TARGET  PARAMETERS* 
2, 37X, 'AIRCRAFT  PARAMETERS',//,'  JSET  TIMET  FREQ  * 
3  *  PRF  PW  BRNGD  V  THETAD  HDGD  » 

4*  SLAD  SLOD  ALT  VELN  VELE',//) 

49  FORMAT!'  ', 1 3, 2X , F 5. 1 , 2X,F 6 . 1 , 2X ,F 5. 1 ,2X ,F4. 2 »2X , F9. 5 , 
12X ,  F 8 . 5 , 2X ,  F9 . 5 , 2X ,  F  5 . 1 , 2X ,  F 8 . 5 , 2X  ,  F10 . 5 , 2 X ,  3F  7.1) 

50  FORMAT  C  1S14X,  'LISTING  OF  KALMAN  FILTER  PARAMC’ERS  * , 


T  ( K) 


1//,'  I  J  KK  K  Gl( K)  G2( K)  T ( K) 

2' E(K) * *6X, 'GATE( K) ' ,/ ) 

FORMAT (7F11. 5) 

FORMAT (6  F13#  5 ) 

FORMAT  Cl  LISTING  OF  BEARING  ANGLFS-OF— ARR  tVAl 
l'AIRCRAFT  NAVIGATION  DATA'  ,///,'  N  HDGD (N ) 


AND  • 
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C 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 


J$t 

*  EXTENDEO  KALMAN  FILTER  COMPUTER  SUBROUTINE 

* 

#jM^***&*  **$#$#£***  ifc**:**#****#*****:****#**:'!'****##*##5**#** 

EMITTER  LOCATION  SOLUTION  USING  EXTENDED  KALMAN 
FILTERING  TECHNIQUES 
EXTENDED  KALMAN  FILTER  INITIALIZATION 

DO  20  1=1 tNTAR 
KI=JSET ( I» 1) 

P11(KI)=2.0 
P12( KI ) =0*  5 
P22(KI J*1.0 
R( KI }=1 «0 

XTD( KI)=- 117.425 03 
YTDIKI 1=33.24187 
XT( KI ) =XTD (KI ) / PI  RAD 
YT(KI)=YTD(KI) /PIRAD 
AT1=(XT  (KI)-SLO(KI)  )*COS ( YTCKI ) ) 

AT2=YT (KI)-SLA(KI) 

TX(KI)=ATAN2(AT1,AT2) 

ER(KI)=THETA(KI J-TX(KI) 

DM=( YTDIKI )-SLAD(KI ) )**2+(XTD(KI )~SLOD(KI) )**2 
1*(C0S(YT (KI)) )**2 

DMX (KIi=(YTD(KI)-SLAD(KI))*COS(YT(KI))/DM 
DMYIKI )=-(XTO< KI )— SLOD( KI } ) * ( ( YTD{ KI J-SLAD (K I )) * 
1SINIYT (KI ) ) +COS ( YT  t  K I ) ) ) /DM 
DG=P11  (  KI  )*DMX(KI)**2+2.0*P12(KI  )*DMX( K I ) *DMY( K I ) 
1+P22(KI )*DMY(KI )**2+R( KI ) 

GX(KI)=(P11(KI)*DMX(KI ) +P12 { K I ) *DM Y( KI ) )/DG 
GY(  KI  I  =  (  P12  ( KI  )*DMX(KI)+P22(KI)*DMY(KI) )/DG 

START  OF  KALMAN  FILTER  PREDICTION  PROBLEM 

NSTA=NST { I ) 

DO  21  J=2,NSTA 
22  K=JSET(I,J) 

KK=JSET( I t J-l ) 

Q1 1 ( K )  =  0. 10 
Q12 ( K) =0. 0 
Q22( K) =0. 10 
Rt  K)  =  l  .0 


C 

C  START  OF  EXTENDED  KALMAN  FILTER  RECURSION  EQUATIONS 
C 

P11(K)=P11(KK)*(1.0-GX(KK)*DMX(KK) )-P12(KK )*GX( KK)* 
1DMY(KK)+Q11(K) 

P12(K)=P12(KK)*(  1. O-GX  ItCK }  *DMX {  KK)  )-P22( KK.  )*GX(  KK)  * 
1DMY ( KK ) +Q12 ( K) 

P22(K)=P22(KK)*< 1. 0-GY( KK) *DMY( KK) )-P12 ( KK) *GY( KK) * 
1 DMX I KK )+Q22 (K ) 

DM=(YTD(KK)-SLAD(K) ) **2+ (XTD( KK )-SLOD( K ) )**2 
1*(C0S{ YT(KK) ) )**2 

DMX ( K )  =  (YTD(KK) -SL  AD (K ) ) *COS (YT ( KK  ) ) /DM 
DMY( K) =-( XTD( KK)-SLOD(K) )*( (YTD ( KK )-SL AD(K ) ) * 

1SINI YT(KK) )+COS(YT(KK) ) ) /DM 
DG=P1 1  { K )  *DMX  (K)=*r*2+2.0*P12(K)*DMX(K)*DMY(K)  + 
1P22(K)*DMY(K)**2+R(K) 

GX(K)=(P11(K) *DMX ( K ) +P 12 ( K ) *DMY { K) )/DG 
GY(  K)  =  (  P12  (K) *DMX  (  K )  -!  P22  ( K  )  *DMY  ( K)  )/DG 
AT1=(XT(KK)-SL0(K) )*COS(YT(KK) ) 

AT2=YT (KK)-SLA(K ) 

TX( K)  =  AT AN2 ( ATI »  AT2 ) 

ER(K)=THETA(K)-TX(K) 

XTD(K)=XTD(KK)+GX(K)*ER(K) 

YTD(K)=YTD(KK)+GY( K)*ER(K) 

XT(K)=XTD(K)/PIRAD 
YT (K)=YTD(K)/PIRAO 
21  CONTINUE 
20  CONTINUE 
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